2 * ARAnyM console driver
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
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>
20 #include <asm/natfeat.h>
23 static struct tty_port nfcon_tty_port;
24 static struct tty_driver *nfcon_tty_driver;
26 static void nfputs(const char *str, unsigned int count)
29 unsigned long phys = virt_to_phys(buf);
34 nf_call(stderr_id, phys);
38 memcpy(buf, str, count);
40 nf_call(stderr_id, phys);
43 static void nfcon_write(struct console *con, const char *str,
49 static struct tty_driver *nfcon_device(struct console *con, int *index)
52 return (con->flags & CON_ENABLED) ? nfcon_tty_driver : NULL;
55 static struct console nf_console = {
58 .device = nfcon_device,
59 .flags = CON_PRINTBUFFER,
64 static int nfcon_tty_open(struct tty_struct *tty, struct file *filp)
69 static void nfcon_tty_close(struct tty_struct *tty, struct file *filp)
73 static int nfcon_tty_write(struct tty_struct *tty, const unsigned char *buf,
80 static int nfcon_tty_put_char(struct tty_struct *tty, unsigned char ch)
82 char temp[2] = { ch, 0 };
84 nf_call(stderr_id, virt_to_phys(temp));
88 static unsigned int nfcon_tty_write_room(struct tty_struct *tty)
93 static 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,
103 static int __init nf_debug_setup(char *arg)
105 if (strcmp(arg, "nfcon"))
108 stderr_id = nf_get_id("NF_STDERR");
110 nf_console.flags |= CON_ENABLED;
111 register_console(&nf_console);
117 early_param("debug", nf_debug_setup);
121 static int __init nfcon_init(void)
123 struct tty_driver *driver;
126 stderr_id = nf_get_id("NF_STDERR");
130 driver = tty_alloc_driver(1, TTY_DRIVER_REAL_RAW);
132 return PTR_ERR(driver);
134 tty_port_init(&nfcon_tty_port);
136 driver->driver_name = "nfcon";
137 driver->name = "nfcon";
138 driver->type = TTY_DRIVER_TYPE_SYSTEM;
139 driver->subtype = SYSTEM_TYPE_TTY;
140 driver->init_termios = tty_std_termios;
142 tty_set_operations(driver, &nfcon_tty_ops);
143 tty_port_link_device(&nfcon_tty_port, driver, 0);
144 res = tty_register_driver(driver);
146 pr_err("failed to register nfcon tty driver\n");
147 tty_driver_kref_put(driver);
148 tty_port_destroy(&nfcon_tty_port);
152 nfcon_tty_driver = driver;
154 if (!(nf_console.flags & CON_ENABLED))
155 register_console(&nf_console);
160 static void __exit nfcon_exit(void)
162 unregister_console(&nf_console);
163 tty_unregister_driver(nfcon_tty_driver);
164 tty_driver_kref_put(nfcon_tty_driver);
165 tty_port_destroy(&nfcon_tty_port);
168 module_init(nfcon_init);
169 module_exit(nfcon_exit);
171 MODULE_LICENSE("GPL");