162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * Copyright (C) 2000, 2001 Jeff Dike (jdike@karaya.com)
462306a36Sopenharmony_ci */
562306a36Sopenharmony_ci
662306a36Sopenharmony_ci#include <linux/posix_types.h>
762306a36Sopenharmony_ci#include <linux/tty.h>
862306a36Sopenharmony_ci#include <linux/tty_flip.h>
962306a36Sopenharmony_ci#include <linux/types.h>
1062306a36Sopenharmony_ci#include <linux/major.h>
1162306a36Sopenharmony_ci#include <linux/kdev_t.h>
1262306a36Sopenharmony_ci#include <linux/console.h>
1362306a36Sopenharmony_ci#include <linux/string.h>
1462306a36Sopenharmony_ci#include <linux/sched.h>
1562306a36Sopenharmony_ci#include <linux/list.h>
1662306a36Sopenharmony_ci#include <linux/init.h>
1762306a36Sopenharmony_ci#include <linux/interrupt.h>
1862306a36Sopenharmony_ci#include <linux/slab.h>
1962306a36Sopenharmony_ci#include <linux/hardirq.h>
2062306a36Sopenharmony_ci#include <asm/current.h>
2162306a36Sopenharmony_ci#include <asm/irq.h>
2262306a36Sopenharmony_ci#include "stdio_console.h"
2362306a36Sopenharmony_ci#include "chan.h"
2462306a36Sopenharmony_ci#include <irq_user.h>
2562306a36Sopenharmony_ci#include "mconsole_kern.h"
2662306a36Sopenharmony_ci#include <init.h>
2762306a36Sopenharmony_ci
2862306a36Sopenharmony_ci#define MAX_TTYS (16)
2962306a36Sopenharmony_ci
3062306a36Sopenharmony_cistatic void stdio_announce(char *dev_name, int dev)
3162306a36Sopenharmony_ci{
3262306a36Sopenharmony_ci	printk(KERN_INFO "Virtual console %d assigned device '%s'\n", dev,
3362306a36Sopenharmony_ci	       dev_name);
3462306a36Sopenharmony_ci}
3562306a36Sopenharmony_ci
3662306a36Sopenharmony_ci/* Almost const, except that xterm_title may be changed in an initcall */
3762306a36Sopenharmony_cistatic struct chan_opts opts = {
3862306a36Sopenharmony_ci	.announce 	= stdio_announce,
3962306a36Sopenharmony_ci	.xterm_title	= "Virtual Console #%d",
4062306a36Sopenharmony_ci	.raw		= 1,
4162306a36Sopenharmony_ci};
4262306a36Sopenharmony_ci
4362306a36Sopenharmony_cistatic int con_config(char *str, char **error_out);
4462306a36Sopenharmony_cistatic int con_get_config(char *dev, char *str, int size, char **error_out);
4562306a36Sopenharmony_cistatic int con_remove(int n, char **con_remove);
4662306a36Sopenharmony_ci
4762306a36Sopenharmony_ci
4862306a36Sopenharmony_ci/* Const, except for .mc.list */
4962306a36Sopenharmony_cistatic struct line_driver driver = {
5062306a36Sopenharmony_ci	.name 			= "UML console",
5162306a36Sopenharmony_ci	.device_name 		= "tty",
5262306a36Sopenharmony_ci	.major 			= TTY_MAJOR,
5362306a36Sopenharmony_ci	.minor_start 		= 0,
5462306a36Sopenharmony_ci	.type 		 	= TTY_DRIVER_TYPE_CONSOLE,
5562306a36Sopenharmony_ci	.subtype 	 	= SYSTEM_TYPE_CONSOLE,
5662306a36Sopenharmony_ci	.read_irq_name 		= "console",
5762306a36Sopenharmony_ci	.write_irq_name 	= "console-write",
5862306a36Sopenharmony_ci	.mc  = {
5962306a36Sopenharmony_ci		.list		= LIST_HEAD_INIT(driver.mc.list),
6062306a36Sopenharmony_ci		.name  		= "con",
6162306a36Sopenharmony_ci		.config 	= con_config,
6262306a36Sopenharmony_ci		.get_config 	= con_get_config,
6362306a36Sopenharmony_ci		.id		= line_id,
6462306a36Sopenharmony_ci		.remove 	= con_remove,
6562306a36Sopenharmony_ci	},
6662306a36Sopenharmony_ci};
6762306a36Sopenharmony_ci
6862306a36Sopenharmony_ci/* The array is initialized by line_init, at initcall time.  The
6962306a36Sopenharmony_ci * elements are locked individually as needed.
7062306a36Sopenharmony_ci */
7162306a36Sopenharmony_cistatic char *vt_conf[MAX_TTYS];
7262306a36Sopenharmony_cistatic char *def_conf;
7362306a36Sopenharmony_cistatic struct line vts[MAX_TTYS];
7462306a36Sopenharmony_ci
7562306a36Sopenharmony_cistatic int con_config(char *str, char **error_out)
7662306a36Sopenharmony_ci{
7762306a36Sopenharmony_ci	return line_config(vts, ARRAY_SIZE(vts), str, &opts, error_out);
7862306a36Sopenharmony_ci}
7962306a36Sopenharmony_ci
8062306a36Sopenharmony_cistatic int con_get_config(char *dev, char *str, int size, char **error_out)
8162306a36Sopenharmony_ci{
8262306a36Sopenharmony_ci	return line_get_config(dev, vts, ARRAY_SIZE(vts), str, size, error_out);
8362306a36Sopenharmony_ci}
8462306a36Sopenharmony_ci
8562306a36Sopenharmony_cistatic int con_remove(int n, char **error_out)
8662306a36Sopenharmony_ci{
8762306a36Sopenharmony_ci	return line_remove(vts, ARRAY_SIZE(vts), n, error_out);
8862306a36Sopenharmony_ci}
8962306a36Sopenharmony_ci
9062306a36Sopenharmony_ci/* Set in an initcall, checked in an exitcall */
9162306a36Sopenharmony_cistatic int con_init_done;
9262306a36Sopenharmony_ci
9362306a36Sopenharmony_cistatic int con_install(struct tty_driver *driver, struct tty_struct *tty)
9462306a36Sopenharmony_ci{
9562306a36Sopenharmony_ci	return line_install(driver, tty, &vts[tty->index]);
9662306a36Sopenharmony_ci}
9762306a36Sopenharmony_ci
9862306a36Sopenharmony_cistatic const struct tty_operations console_ops = {
9962306a36Sopenharmony_ci	.open 	 		= line_open,
10062306a36Sopenharmony_ci	.install		= con_install,
10162306a36Sopenharmony_ci	.close 	 		= line_close,
10262306a36Sopenharmony_ci	.write 	 		= line_write,
10362306a36Sopenharmony_ci	.write_room		= line_write_room,
10462306a36Sopenharmony_ci	.chars_in_buffer 	= line_chars_in_buffer,
10562306a36Sopenharmony_ci	.flush_buffer 		= line_flush_buffer,
10662306a36Sopenharmony_ci	.flush_chars 		= line_flush_chars,
10762306a36Sopenharmony_ci	.throttle 		= line_throttle,
10862306a36Sopenharmony_ci	.unthrottle 		= line_unthrottle,
10962306a36Sopenharmony_ci	.hangup			= line_hangup,
11062306a36Sopenharmony_ci};
11162306a36Sopenharmony_ci
11262306a36Sopenharmony_cistatic void uml_console_write(struct console *console, const char *string,
11362306a36Sopenharmony_ci			      unsigned len)
11462306a36Sopenharmony_ci{
11562306a36Sopenharmony_ci	struct line *line = &vts[console->index];
11662306a36Sopenharmony_ci	unsigned long flags;
11762306a36Sopenharmony_ci
11862306a36Sopenharmony_ci	spin_lock_irqsave(&line->lock, flags);
11962306a36Sopenharmony_ci	console_write_chan(line->chan_out, string, len);
12062306a36Sopenharmony_ci	spin_unlock_irqrestore(&line->lock, flags);
12162306a36Sopenharmony_ci}
12262306a36Sopenharmony_ci
12362306a36Sopenharmony_cistatic struct tty_driver *uml_console_device(struct console *c, int *index)
12462306a36Sopenharmony_ci{
12562306a36Sopenharmony_ci	*index = c->index;
12662306a36Sopenharmony_ci	return driver.driver;
12762306a36Sopenharmony_ci}
12862306a36Sopenharmony_ci
12962306a36Sopenharmony_cistatic int uml_console_setup(struct console *co, char *options)
13062306a36Sopenharmony_ci{
13162306a36Sopenharmony_ci	struct line *line = &vts[co->index];
13262306a36Sopenharmony_ci
13362306a36Sopenharmony_ci	return console_open_chan(line, co);
13462306a36Sopenharmony_ci}
13562306a36Sopenharmony_ci
13662306a36Sopenharmony_ci/* No locking for register_console call - relies on single-threaded initcalls */
13762306a36Sopenharmony_cistatic struct console stdiocons = {
13862306a36Sopenharmony_ci	.name		= "tty",
13962306a36Sopenharmony_ci	.write		= uml_console_write,
14062306a36Sopenharmony_ci	.device		= uml_console_device,
14162306a36Sopenharmony_ci	.setup		= uml_console_setup,
14262306a36Sopenharmony_ci	.flags		= CON_PRINTBUFFER|CON_ANYTIME,
14362306a36Sopenharmony_ci	.index		= -1,
14462306a36Sopenharmony_ci};
14562306a36Sopenharmony_ci
14662306a36Sopenharmony_cistatic int stdio_init(void)
14762306a36Sopenharmony_ci{
14862306a36Sopenharmony_ci	char *new_title;
14962306a36Sopenharmony_ci	int err;
15062306a36Sopenharmony_ci	int i;
15162306a36Sopenharmony_ci
15262306a36Sopenharmony_ci	err = register_lines(&driver, &console_ops, vts,
15362306a36Sopenharmony_ci					ARRAY_SIZE(vts));
15462306a36Sopenharmony_ci	if (err)
15562306a36Sopenharmony_ci		return err;
15662306a36Sopenharmony_ci
15762306a36Sopenharmony_ci	printk(KERN_INFO "Initialized stdio console driver\n");
15862306a36Sopenharmony_ci
15962306a36Sopenharmony_ci	new_title = add_xterm_umid(opts.xterm_title);
16062306a36Sopenharmony_ci	if(new_title != NULL)
16162306a36Sopenharmony_ci		opts.xterm_title = new_title;
16262306a36Sopenharmony_ci
16362306a36Sopenharmony_ci	for (i = 0; i < MAX_TTYS; i++) {
16462306a36Sopenharmony_ci		char *error;
16562306a36Sopenharmony_ci		char *s = vt_conf[i];
16662306a36Sopenharmony_ci		if (!s)
16762306a36Sopenharmony_ci			s = def_conf;
16862306a36Sopenharmony_ci		if (!s)
16962306a36Sopenharmony_ci			s = i ? CONFIG_CON_CHAN : CONFIG_CON_ZERO_CHAN;
17062306a36Sopenharmony_ci		if (setup_one_line(vts, i, s, &opts, &error))
17162306a36Sopenharmony_ci			printk(KERN_ERR "setup_one_line failed for "
17262306a36Sopenharmony_ci			       "device %d : %s\n", i, error);
17362306a36Sopenharmony_ci	}
17462306a36Sopenharmony_ci
17562306a36Sopenharmony_ci	con_init_done = 1;
17662306a36Sopenharmony_ci	register_console(&stdiocons);
17762306a36Sopenharmony_ci	return 0;
17862306a36Sopenharmony_ci}
17962306a36Sopenharmony_cilate_initcall(stdio_init);
18062306a36Sopenharmony_ci
18162306a36Sopenharmony_cistatic void console_exit(void)
18262306a36Sopenharmony_ci{
18362306a36Sopenharmony_ci	if (!con_init_done)
18462306a36Sopenharmony_ci		return;
18562306a36Sopenharmony_ci	close_lines(vts, ARRAY_SIZE(vts));
18662306a36Sopenharmony_ci}
18762306a36Sopenharmony_ci__uml_exitcall(console_exit);
18862306a36Sopenharmony_ci
18962306a36Sopenharmony_cistatic int console_chan_setup(char *str)
19062306a36Sopenharmony_ci{
19162306a36Sopenharmony_ci	if (!strncmp(str, "sole=", 5))	/* console= option specifies tty */
19262306a36Sopenharmony_ci		return 0;
19362306a36Sopenharmony_ci
19462306a36Sopenharmony_ci	line_setup(vt_conf, MAX_TTYS, &def_conf, str, "console");
19562306a36Sopenharmony_ci	return 1;
19662306a36Sopenharmony_ci}
19762306a36Sopenharmony_ci__setup("con", console_chan_setup);
19862306a36Sopenharmony_ci__channel_help(console_chan_setup, "con");
199