1 // SPDX-License-Identifier: GPL-2.0
3 * linux/arch/alpha/kernel/srmcons.c
5 * Callback based driver for SRM Console console device.
6 * (TTY driver and console driver)
9 #include <linux/kernel.h>
10 #include <linux/init.h>
11 #include <linux/console.h>
12 #include <linux/delay.h>
14 #include <linux/slab.h>
15 #include <linux/spinlock.h>
16 #include <linux/timer.h>
17 #include <linux/tty.h>
18 #include <linux/tty_driver.h>
19 #include <linux/tty_flip.h>
21 #include <asm/console.h>
22 #include <linux/uaccess.h>
27 static DEFINE_SPINLOCK(srmcons_callback_lock);
28 static int srm_is_registered_console = 0;
33 #define MAX_SRM_CONSOLE_DEVICES 1 /* only support 1 console device */
35 struct srmcons_private {
37 struct timer_list timer;
40 typedef union _srmcons_result {
43 unsigned long status :3;
48 /* called with callback_lock held */
50 srmcons_do_receive_chars(struct tty_port *port)
52 srmcons_result result;
53 int count = 0, loops = 0;
56 result.as_long = callback_getc(0);
57 if (result.bits.status < 2) {
58 tty_insert_flip_char(port, (u8)result.bits.c, 0);
61 } while((result.bits.status & 1) && (++loops < 10));
64 tty_flip_buffer_push(port);
70 srmcons_receive_chars(struct timer_list *t)
72 struct srmcons_private *srmconsp = from_timer(srmconsp, t, timer);
73 struct tty_port *port = &srmconsp->port;
77 local_irq_save(flags);
78 if (spin_trylock(&srmcons_callback_lock)) {
79 if (!srmcons_do_receive_chars(port))
81 spin_unlock(&srmcons_callback_lock);
84 spin_lock(&port->lock);
86 mod_timer(&srmconsp->timer, jiffies + incr);
87 spin_unlock(&port->lock);
89 local_irq_restore(flags);
92 /* called with callback_lock held */
94 srmcons_do_write(struct tty_port *port, const u8 *buf, size_t count)
97 srmcons_result result;
100 bool need_cr = false;
102 * Break it up into reasonable size chunks to allow a chance
103 * for input to get in
105 for (c = 0; c < min_t(size_t, 128U, count) && !need_cr; c++)
110 result.as_long = callback_puts(0, buf, c);
112 count -= result.bits.c;
113 buf += result.bits.c;
116 * Check for pending input iff a tty port was provided
119 srmcons_do_receive_chars(port);
123 result.as_long = callback_puts(0, "\r", 1);
124 if (result.bits.c > 0)
131 srmcons_write(struct tty_struct *tty, const u8 *buf, size_t count)
135 spin_lock_irqsave(&srmcons_callback_lock, flags);
136 srmcons_do_write(tty->port, buf, count);
137 spin_unlock_irqrestore(&srmcons_callback_lock, flags);
143 srmcons_write_room(struct tty_struct *tty)
149 srmcons_open(struct tty_struct *tty, struct file *filp)
151 struct srmcons_private *srmconsp = &srmcons_singleton;
152 struct tty_port *port = &srmconsp->port;
155 spin_lock_irqsave(&port->lock, flags);
158 tty->driver_data = srmconsp;
160 port->tty = tty; /* XXX proper refcounting */
161 mod_timer(&srmconsp->timer, jiffies + 10);
164 spin_unlock_irqrestore(&port->lock, flags);
170 srmcons_close(struct tty_struct *tty, struct file *filp)
172 struct srmcons_private *srmconsp = tty->driver_data;
173 struct tty_port *port = &srmconsp->port;
176 spin_lock_irqsave(&port->lock, flags);
178 if (tty->count == 1) {
180 del_timer(&srmconsp->timer);
183 spin_unlock_irqrestore(&port->lock, flags);
187 static struct tty_driver *srmcons_driver;
189 static const struct tty_operations srmcons_ops = {
190 .open = srmcons_open,
191 .close = srmcons_close,
192 .write = srmcons_write,
193 .write_room = srmcons_write_room,
199 timer_setup(&srmcons_singleton.timer, srmcons_receive_chars, 0);
200 if (srm_is_registered_console) {
201 struct tty_driver *driver;
204 driver = tty_alloc_driver(MAX_SRM_CONSOLE_DEVICES, 0);
206 return PTR_ERR(driver);
208 tty_port_init(&srmcons_singleton.port);
210 driver->driver_name = "srm";
211 driver->name = "srm";
212 driver->major = 0; /* dynamic */
213 driver->minor_start = 0;
214 driver->type = TTY_DRIVER_TYPE_SYSTEM;
215 driver->subtype = SYSTEM_TYPE_SYSCONS;
216 driver->init_termios = tty_std_termios;
217 tty_set_operations(driver, &srmcons_ops);
218 tty_port_link_device(&srmcons_singleton.port, driver, 0);
219 err = tty_register_driver(driver);
221 tty_driver_kref_put(driver);
222 tty_port_destroy(&srmcons_singleton.port);
225 srmcons_driver = driver;
230 device_initcall(srmcons_init);
237 srm_console_write(struct console *co, const char *s, unsigned count)
241 spin_lock_irqsave(&srmcons_callback_lock, flags);
242 srmcons_do_write(NULL, s, count);
243 spin_unlock_irqrestore(&srmcons_callback_lock, flags);
246 static struct tty_driver *
247 srm_console_device(struct console *co, int *index)
250 return srmcons_driver;
254 srm_console_setup(struct console *co, char *options)
259 static struct console srmcons = {
261 .write = srm_console_write,
262 .device = srm_console_device,
263 .setup = srm_console_setup,
264 .flags = CON_PRINTBUFFER | CON_BOOT,
269 register_srm_console(void)
271 if (!srm_is_registered_console) {
272 callback_open_console();
273 register_console(&srmcons);
274 srm_is_registered_console = 1;
279 unregister_srm_console(void)
281 if (srm_is_registered_console) {
282 callback_close_console();
283 unregister_console(&srmcons);
284 srm_is_registered_console = 0;