162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * Copyright (C) 2019 Axis Communications AB 462306a36Sopenharmony_ci * 562306a36Sopenharmony_ci * Based on ttyprintk.c: 662306a36Sopenharmony_ci * Copyright (C) 2010 Samo Pogacnik 762306a36Sopenharmony_ci */ 862306a36Sopenharmony_ci 962306a36Sopenharmony_ci#include <linux/console.h> 1062306a36Sopenharmony_ci#include <linux/module.h> 1162306a36Sopenharmony_ci#include <linux/tty.h> 1262306a36Sopenharmony_ci 1362306a36Sopenharmony_cistatic const struct tty_port_operations ttynull_port_ops; 1462306a36Sopenharmony_cistatic struct tty_driver *ttynull_driver; 1562306a36Sopenharmony_cistatic struct tty_port ttynull_port; 1662306a36Sopenharmony_ci 1762306a36Sopenharmony_cistatic int ttynull_open(struct tty_struct *tty, struct file *filp) 1862306a36Sopenharmony_ci{ 1962306a36Sopenharmony_ci return tty_port_open(&ttynull_port, tty, filp); 2062306a36Sopenharmony_ci} 2162306a36Sopenharmony_ci 2262306a36Sopenharmony_cistatic void ttynull_close(struct tty_struct *tty, struct file *filp) 2362306a36Sopenharmony_ci{ 2462306a36Sopenharmony_ci tty_port_close(&ttynull_port, tty, filp); 2562306a36Sopenharmony_ci} 2662306a36Sopenharmony_ci 2762306a36Sopenharmony_cistatic void ttynull_hangup(struct tty_struct *tty) 2862306a36Sopenharmony_ci{ 2962306a36Sopenharmony_ci tty_port_hangup(&ttynull_port); 3062306a36Sopenharmony_ci} 3162306a36Sopenharmony_ci 3262306a36Sopenharmony_cistatic ssize_t ttynull_write(struct tty_struct *tty, const u8 *buf, 3362306a36Sopenharmony_ci size_t count) 3462306a36Sopenharmony_ci{ 3562306a36Sopenharmony_ci return count; 3662306a36Sopenharmony_ci} 3762306a36Sopenharmony_ci 3862306a36Sopenharmony_cistatic unsigned int ttynull_write_room(struct tty_struct *tty) 3962306a36Sopenharmony_ci{ 4062306a36Sopenharmony_ci return 65536; 4162306a36Sopenharmony_ci} 4262306a36Sopenharmony_ci 4362306a36Sopenharmony_cistatic const struct tty_operations ttynull_ops = { 4462306a36Sopenharmony_ci .open = ttynull_open, 4562306a36Sopenharmony_ci .close = ttynull_close, 4662306a36Sopenharmony_ci .hangup = ttynull_hangup, 4762306a36Sopenharmony_ci .write = ttynull_write, 4862306a36Sopenharmony_ci .write_room = ttynull_write_room, 4962306a36Sopenharmony_ci}; 5062306a36Sopenharmony_ci 5162306a36Sopenharmony_cistatic struct tty_driver *ttynull_device(struct console *c, int *index) 5262306a36Sopenharmony_ci{ 5362306a36Sopenharmony_ci *index = 0; 5462306a36Sopenharmony_ci return ttynull_driver; 5562306a36Sopenharmony_ci} 5662306a36Sopenharmony_ci 5762306a36Sopenharmony_cistatic struct console ttynull_console = { 5862306a36Sopenharmony_ci .name = "ttynull", 5962306a36Sopenharmony_ci .device = ttynull_device, 6062306a36Sopenharmony_ci}; 6162306a36Sopenharmony_ci 6262306a36Sopenharmony_cistatic int __init ttynull_init(void) 6362306a36Sopenharmony_ci{ 6462306a36Sopenharmony_ci struct tty_driver *driver; 6562306a36Sopenharmony_ci int ret; 6662306a36Sopenharmony_ci 6762306a36Sopenharmony_ci driver = tty_alloc_driver(1, 6862306a36Sopenharmony_ci TTY_DRIVER_RESET_TERMIOS | 6962306a36Sopenharmony_ci TTY_DRIVER_REAL_RAW | 7062306a36Sopenharmony_ci TTY_DRIVER_UNNUMBERED_NODE); 7162306a36Sopenharmony_ci if (IS_ERR(driver)) 7262306a36Sopenharmony_ci return PTR_ERR(driver); 7362306a36Sopenharmony_ci 7462306a36Sopenharmony_ci tty_port_init(&ttynull_port); 7562306a36Sopenharmony_ci ttynull_port.ops = &ttynull_port_ops; 7662306a36Sopenharmony_ci 7762306a36Sopenharmony_ci driver->driver_name = "ttynull"; 7862306a36Sopenharmony_ci driver->name = "ttynull"; 7962306a36Sopenharmony_ci driver->type = TTY_DRIVER_TYPE_CONSOLE; 8062306a36Sopenharmony_ci driver->init_termios = tty_std_termios; 8162306a36Sopenharmony_ci driver->init_termios.c_oflag = OPOST | OCRNL | ONOCR | ONLRET; 8262306a36Sopenharmony_ci tty_set_operations(driver, &ttynull_ops); 8362306a36Sopenharmony_ci tty_port_link_device(&ttynull_port, driver, 0); 8462306a36Sopenharmony_ci 8562306a36Sopenharmony_ci ret = tty_register_driver(driver); 8662306a36Sopenharmony_ci if (ret < 0) { 8762306a36Sopenharmony_ci tty_driver_kref_put(driver); 8862306a36Sopenharmony_ci tty_port_destroy(&ttynull_port); 8962306a36Sopenharmony_ci return ret; 9062306a36Sopenharmony_ci } 9162306a36Sopenharmony_ci 9262306a36Sopenharmony_ci ttynull_driver = driver; 9362306a36Sopenharmony_ci register_console(&ttynull_console); 9462306a36Sopenharmony_ci 9562306a36Sopenharmony_ci return 0; 9662306a36Sopenharmony_ci} 9762306a36Sopenharmony_ci 9862306a36Sopenharmony_cistatic void __exit ttynull_exit(void) 9962306a36Sopenharmony_ci{ 10062306a36Sopenharmony_ci unregister_console(&ttynull_console); 10162306a36Sopenharmony_ci tty_unregister_driver(ttynull_driver); 10262306a36Sopenharmony_ci tty_driver_kref_put(ttynull_driver); 10362306a36Sopenharmony_ci tty_port_destroy(&ttynull_port); 10462306a36Sopenharmony_ci} 10562306a36Sopenharmony_ci 10662306a36Sopenharmony_cimodule_init(ttynull_init); 10762306a36Sopenharmony_cimodule_exit(ttynull_exit); 10862306a36Sopenharmony_ci 10962306a36Sopenharmony_ciMODULE_LICENSE("GPL v2"); 110