1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun * Simple kernel console driver for STM devices
4*4882a593Smuzhiyun * Copyright (c) 2014, Intel Corporation.
5*4882a593Smuzhiyun *
6*4882a593Smuzhiyun * STM console will send kernel messages over STM devices to a trace host.
7*4882a593Smuzhiyun */
8*4882a593Smuzhiyun
9*4882a593Smuzhiyun #include <linux/kernel.h>
10*4882a593Smuzhiyun #include <linux/module.h>
11*4882a593Smuzhiyun #include <linux/console.h>
12*4882a593Smuzhiyun #include <linux/slab.h>
13*4882a593Smuzhiyun #include <linux/stm.h>
14*4882a593Smuzhiyun
15*4882a593Smuzhiyun static int stm_console_link(struct stm_source_data *data);
16*4882a593Smuzhiyun static void stm_console_unlink(struct stm_source_data *data);
17*4882a593Smuzhiyun
18*4882a593Smuzhiyun static struct stm_console {
19*4882a593Smuzhiyun struct stm_source_data data;
20*4882a593Smuzhiyun struct console console;
21*4882a593Smuzhiyun } stm_console = {
22*4882a593Smuzhiyun .data = {
23*4882a593Smuzhiyun .name = "console",
24*4882a593Smuzhiyun .nr_chans = 1,
25*4882a593Smuzhiyun .link = stm_console_link,
26*4882a593Smuzhiyun .unlink = stm_console_unlink,
27*4882a593Smuzhiyun },
28*4882a593Smuzhiyun };
29*4882a593Smuzhiyun
30*4882a593Smuzhiyun static void
stm_console_write(struct console * con,const char * buf,unsigned len)31*4882a593Smuzhiyun stm_console_write(struct console *con, const char *buf, unsigned len)
32*4882a593Smuzhiyun {
33*4882a593Smuzhiyun struct stm_console *sc = container_of(con, struct stm_console, console);
34*4882a593Smuzhiyun
35*4882a593Smuzhiyun stm_source_write(&sc->data, 0, buf, len);
36*4882a593Smuzhiyun }
37*4882a593Smuzhiyun
stm_console_link(struct stm_source_data * data)38*4882a593Smuzhiyun static int stm_console_link(struct stm_source_data *data)
39*4882a593Smuzhiyun {
40*4882a593Smuzhiyun struct stm_console *sc = container_of(data, struct stm_console, data);
41*4882a593Smuzhiyun
42*4882a593Smuzhiyun strcpy(sc->console.name, "stm_console");
43*4882a593Smuzhiyun sc->console.write = stm_console_write;
44*4882a593Smuzhiyun sc->console.flags = CON_ENABLED | CON_PRINTBUFFER;
45*4882a593Smuzhiyun register_console(&sc->console);
46*4882a593Smuzhiyun
47*4882a593Smuzhiyun return 0;
48*4882a593Smuzhiyun }
49*4882a593Smuzhiyun
stm_console_unlink(struct stm_source_data * data)50*4882a593Smuzhiyun static void stm_console_unlink(struct stm_source_data *data)
51*4882a593Smuzhiyun {
52*4882a593Smuzhiyun struct stm_console *sc = container_of(data, struct stm_console, data);
53*4882a593Smuzhiyun
54*4882a593Smuzhiyun unregister_console(&sc->console);
55*4882a593Smuzhiyun }
56*4882a593Smuzhiyun
stm_console_init(void)57*4882a593Smuzhiyun static int stm_console_init(void)
58*4882a593Smuzhiyun {
59*4882a593Smuzhiyun return stm_source_register_device(NULL, &stm_console.data);
60*4882a593Smuzhiyun }
61*4882a593Smuzhiyun
stm_console_exit(void)62*4882a593Smuzhiyun static void stm_console_exit(void)
63*4882a593Smuzhiyun {
64*4882a593Smuzhiyun stm_source_unregister_device(&stm_console.data);
65*4882a593Smuzhiyun }
66*4882a593Smuzhiyun
67*4882a593Smuzhiyun module_init(stm_console_init);
68*4882a593Smuzhiyun module_exit(stm_console_exit);
69*4882a593Smuzhiyun
70*4882a593Smuzhiyun MODULE_LICENSE("GPL v2");
71*4882a593Smuzhiyun MODULE_DESCRIPTION("stm_console driver");
72*4882a593Smuzhiyun MODULE_AUTHOR("Alexander Shishkin <alexander.shishkin@linux.intel.com>");
73