blob: 57e8c8fb5eba2be6a3bddfd5b28b437307c6ef94 [file] [log] [blame]
Roman Zippel37b0b652008-11-18 21:02:19 +01001/*
2 * ARAnyM console driver
3 *
4 * This file is subject to the terms and conditions of the GNU General Public
5 * License. See the file COPYING in the main directory of this archive
6 * for more details.
7 */
8
9#include <linux/module.h>
10#include <linux/init.h>
11#include <linux/console.h>
12#include <linux/tty.h>
13#include <linux/tty_driver.h>
14#include <linux/tty_flip.h>
15#include <linux/slab.h>
16#include <linux/err.h>
17#include <linux/uaccess.h>
Geert Uytterhoeven55490052013-08-14 10:45:00 +020018#include <linux/io.h>
Roman Zippel37b0b652008-11-18 21:02:19 +010019
20#include <asm/natfeat.h>
21
22static int stderr_id;
Jiri Slaby5920c2c2012-08-07 21:47:56 +020023static struct tty_port nfcon_tty_port;
Roman Zippel37b0b652008-11-18 21:02:19 +010024static struct tty_driver *nfcon_tty_driver;
25
26static void nfputs(const char *str, unsigned int count)
27{
28 char buf[68];
Geert Uytterhoeven55490052013-08-14 10:45:00 +020029 unsigned long phys = virt_to_phys(buf);
Roman Zippel37b0b652008-11-18 21:02:19 +010030
31 buf[64] = 0;
32 while (count > 64) {
33 memcpy(buf, str, 64);
Geert Uytterhoeven55490052013-08-14 10:45:00 +020034 nf_call(stderr_id, phys);
Roman Zippel37b0b652008-11-18 21:02:19 +010035 str += 64;
36 count -= 64;
37 }
38 memcpy(buf, str, count);
39 buf[count] = 0;
Geert Uytterhoeven55490052013-08-14 10:45:00 +020040 nf_call(stderr_id, phys);
Roman Zippel37b0b652008-11-18 21:02:19 +010041}
42
43static void nfcon_write(struct console *con, const char *str,
44 unsigned int count)
45{
46 nfputs(str, count);
47}
48
49static struct tty_driver *nfcon_device(struct console *con, int *index)
50{
51 *index = 0;
52 return (con->flags & CON_ENABLED) ? nfcon_tty_driver : NULL;
53}
54
55static struct console nf_console = {
56 .name = "nfcon",
57 .write = nfcon_write,
58 .device = nfcon_device,
59 .flags = CON_PRINTBUFFER,
60 .index = -1,
61};
62
63
64static int nfcon_tty_open(struct tty_struct *tty, struct file *filp)
65{
66 return 0;
67}
68
69static void nfcon_tty_close(struct tty_struct *tty, struct file *filp)
70{
71}
72
73static int nfcon_tty_write(struct tty_struct *tty, const unsigned char *buf,
74 int count)
75{
76 nfputs(buf, count);
77 return count;
78}
79
80static int nfcon_tty_put_char(struct tty_struct *tty, unsigned char ch)
81{
82 char temp[2] = { ch, 0 };
83
Geert Uytterhoeven55490052013-08-14 10:45:00 +020084 nf_call(stderr_id, virt_to_phys(temp));
Roman Zippel37b0b652008-11-18 21:02:19 +010085 return 1;
86}
87
88static int nfcon_tty_write_room(struct tty_struct *tty)
89{
90 return 64;
91}
92
93static const struct tty_operations nfcon_tty_ops = {
94 .open = nfcon_tty_open,
95 .close = nfcon_tty_close,
96 .write = nfcon_tty_write,
97 .put_char = nfcon_tty_put_char,
98 .write_room = nfcon_tty_write_room,
99};
100
101#ifndef MODULE
102
103static int __init nf_debug_setup(char *arg)
104{
105 if (strcmp(arg, "nfcon"))
106 return 0;
107
108 stderr_id = nf_get_id("NF_STDERR");
109 if (stderr_id) {
110 nf_console.flags |= CON_ENABLED;
111 register_console(&nf_console);
112 }
113
114 return 0;
115}
116
117early_param("debug", nf_debug_setup);
118
119#endif /* !MODULE */
120
121static int __init nfcon_init(void)
122{
123 int res;
124
125 stderr_id = nf_get_id("NF_STDERR");
126 if (!stderr_id)
127 return -ENODEV;
128
129 nfcon_tty_driver = alloc_tty_driver(1);
130 if (!nfcon_tty_driver)
131 return -ENOMEM;
132
Jiri Slaby191c5f12012-11-15 09:49:56 +0100133 tty_port_init(&nfcon_tty_port);
134
Roman Zippel37b0b652008-11-18 21:02:19 +0100135 nfcon_tty_driver->driver_name = "nfcon";
136 nfcon_tty_driver->name = "nfcon";
137 nfcon_tty_driver->type = TTY_DRIVER_TYPE_SYSTEM;
138 nfcon_tty_driver->subtype = SYSTEM_TYPE_TTY;
139 nfcon_tty_driver->init_termios = tty_std_termios;
140 nfcon_tty_driver->flags = TTY_DRIVER_REAL_RAW;
141
142 tty_set_operations(nfcon_tty_driver, &nfcon_tty_ops);
Jiri Slaby5920c2c2012-08-07 21:47:56 +0200143 tty_port_link_device(&nfcon_tty_port, nfcon_tty_driver, 0);
Roman Zippel37b0b652008-11-18 21:02:19 +0100144 res = tty_register_driver(nfcon_tty_driver);
145 if (res) {
146 pr_err("failed to register nfcon tty driver\n");
147 put_tty_driver(nfcon_tty_driver);
Jiri Slaby191c5f12012-11-15 09:49:56 +0100148 tty_port_destroy(&nfcon_tty_port);
Roman Zippel37b0b652008-11-18 21:02:19 +0100149 return res;
150 }
151
152 if (!(nf_console.flags & CON_ENABLED))
153 register_console(&nf_console);
154
155 return 0;
156}
157
158static void __exit nfcon_exit(void)
159{
160 unregister_console(&nf_console);
161 tty_unregister_driver(nfcon_tty_driver);
162 put_tty_driver(nfcon_tty_driver);
Jiri Slaby191c5f12012-11-15 09:49:56 +0100163 tty_port_destroy(&nfcon_tty_port);
Roman Zippel37b0b652008-11-18 21:02:19 +0100164}
165
166module_init(nfcon_init);
167module_exit(nfcon_exit);
168
169MODULE_LICENSE("GPL");