16d170f53bfd0d521a15281b4565d3fae9f1ad44
[linux-3.10.git] / arch / m68k / emu / nfcon.c
1 /*
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>
18
19 #include <asm/natfeat.h>
20
21 static int stderr_id;
22 static struct tty_port nfcon_tty_port;
23 static struct tty_driver *nfcon_tty_driver;
24
25 static void nfputs(const char *str, unsigned int count)
26 {
27         char buf[68];
28
29         buf[64] = 0;
30         while (count > 64) {
31                 memcpy(buf, str, 64);
32                 nf_call(stderr_id, buf);
33                 str += 64;
34                 count -= 64;
35         }
36         memcpy(buf, str, count);
37         buf[count] = 0;
38         nf_call(stderr_id, buf);
39 }
40
41 static void nfcon_write(struct console *con, const char *str,
42                         unsigned int count)
43 {
44         nfputs(str, count);
45 }
46
47 static struct tty_driver *nfcon_device(struct console *con, int *index)
48 {
49         *index = 0;
50         return (con->flags & CON_ENABLED) ? nfcon_tty_driver : NULL;
51 }
52
53 static struct console nf_console = {
54         .name   = "nfcon",
55         .write  = nfcon_write,
56         .device = nfcon_device,
57         .flags  = CON_PRINTBUFFER,
58         .index  = -1,
59 };
60
61
62 static int nfcon_tty_open(struct tty_struct *tty, struct file *filp)
63 {
64         return 0;
65 }
66
67 static void nfcon_tty_close(struct tty_struct *tty, struct file *filp)
68 {
69 }
70
71 static int nfcon_tty_write(struct tty_struct *tty, const unsigned char *buf,
72                            int count)
73 {
74         nfputs(buf, count);
75         return count;
76 }
77
78 static int nfcon_tty_put_char(struct tty_struct *tty, unsigned char ch)
79 {
80         char temp[2] = { ch, 0 };
81
82         nf_call(stderr_id, temp);
83         return 1;
84 }
85
86 static int nfcon_tty_write_room(struct tty_struct *tty)
87 {
88         return 64;
89 }
90
91 static const struct tty_operations nfcon_tty_ops = {
92         .open           = nfcon_tty_open,
93         .close          = nfcon_tty_close,
94         .write          = nfcon_tty_write,
95         .put_char       = nfcon_tty_put_char,
96         .write_room     = nfcon_tty_write_room,
97 };
98
99 #ifndef MODULE
100
101 static int __init nf_debug_setup(char *arg)
102 {
103         if (strcmp(arg, "nfcon"))
104                 return 0;
105
106         stderr_id = nf_get_id("NF_STDERR");
107         if (stderr_id) {
108                 nf_console.flags |= CON_ENABLED;
109                 register_console(&nf_console);
110         }
111
112         return 0;
113 }
114
115 early_param("debug", nf_debug_setup);
116
117 #endif /* !MODULE */
118
119 static int __init nfcon_init(void)
120 {
121         int res;
122
123         tty_port_init(&nfcon_tty_port);
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
133         nfcon_tty_driver->driver_name = "nfcon";
134         nfcon_tty_driver->name = "nfcon";
135         nfcon_tty_driver->type = TTY_DRIVER_TYPE_SYSTEM;
136         nfcon_tty_driver->subtype = SYSTEM_TYPE_TTY;
137         nfcon_tty_driver->init_termios = tty_std_termios;
138         nfcon_tty_driver->flags = TTY_DRIVER_REAL_RAW;
139
140         tty_set_operations(nfcon_tty_driver, &nfcon_tty_ops);
141         tty_port_link_device(&nfcon_tty_port, nfcon_tty_driver, 0);
142         res = tty_register_driver(nfcon_tty_driver);
143         if (res) {
144                 pr_err("failed to register nfcon tty driver\n");
145                 put_tty_driver(nfcon_tty_driver);
146                 return res;
147         }
148
149         if (!(nf_console.flags & CON_ENABLED))
150                 register_console(&nf_console);
151
152         return 0;
153 }
154
155 static void __exit nfcon_exit(void)
156 {
157         unregister_console(&nf_console);
158         tty_unregister_driver(nfcon_tty_driver);
159         put_tty_driver(nfcon_tty_driver);
160 }
161
162 module_init(nfcon_init);
163 module_exit(nfcon_exit);
164
165 MODULE_LICENSE("GPL");