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