1*4882a593Smuzhiyun /* SPDX-License-Identifier: GPL-2.0 */
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun * Copyright (C) 2008 David Gibson, IBM Corporation
4*4882a593Smuzhiyun * Copyright (C) 2012 Regents of the University of California
5*4882a593Smuzhiyun * Copyright (C) 2017 SiFive
6*4882a593Smuzhiyun */
7*4882a593Smuzhiyun
8*4882a593Smuzhiyun #include <linux/console.h>
9*4882a593Smuzhiyun #include <linux/err.h>
10*4882a593Smuzhiyun #include <linux/init.h>
11*4882a593Smuzhiyun #include <linux/moduleparam.h>
12*4882a593Smuzhiyun #include <linux/types.h>
13*4882a593Smuzhiyun
14*4882a593Smuzhiyun #include <asm/sbi.h>
15*4882a593Smuzhiyun
16*4882a593Smuzhiyun #include "hvc_console.h"
17*4882a593Smuzhiyun
hvc_sbi_tty_put(uint32_t vtermno,const char * buf,int count)18*4882a593Smuzhiyun static int hvc_sbi_tty_put(uint32_t vtermno, const char *buf, int count)
19*4882a593Smuzhiyun {
20*4882a593Smuzhiyun int i;
21*4882a593Smuzhiyun
22*4882a593Smuzhiyun for (i = 0; i < count; i++)
23*4882a593Smuzhiyun sbi_console_putchar(buf[i]);
24*4882a593Smuzhiyun
25*4882a593Smuzhiyun return i;
26*4882a593Smuzhiyun }
27*4882a593Smuzhiyun
hvc_sbi_tty_get(uint32_t vtermno,char * buf,int count)28*4882a593Smuzhiyun static int hvc_sbi_tty_get(uint32_t vtermno, char *buf, int count)
29*4882a593Smuzhiyun {
30*4882a593Smuzhiyun int i, c;
31*4882a593Smuzhiyun
32*4882a593Smuzhiyun for (i = 0; i < count; i++) {
33*4882a593Smuzhiyun c = sbi_console_getchar();
34*4882a593Smuzhiyun if (c < 0)
35*4882a593Smuzhiyun break;
36*4882a593Smuzhiyun buf[i] = c;
37*4882a593Smuzhiyun }
38*4882a593Smuzhiyun
39*4882a593Smuzhiyun return i;
40*4882a593Smuzhiyun }
41*4882a593Smuzhiyun
42*4882a593Smuzhiyun static const struct hv_ops hvc_sbi_ops = {
43*4882a593Smuzhiyun .get_chars = hvc_sbi_tty_get,
44*4882a593Smuzhiyun .put_chars = hvc_sbi_tty_put,
45*4882a593Smuzhiyun };
46*4882a593Smuzhiyun
hvc_sbi_init(void)47*4882a593Smuzhiyun static int __init hvc_sbi_init(void)
48*4882a593Smuzhiyun {
49*4882a593Smuzhiyun return PTR_ERR_OR_ZERO(hvc_alloc(0, 0, &hvc_sbi_ops, 16));
50*4882a593Smuzhiyun }
51*4882a593Smuzhiyun device_initcall(hvc_sbi_init);
52*4882a593Smuzhiyun
hvc_sbi_console_init(void)53*4882a593Smuzhiyun static int __init hvc_sbi_console_init(void)
54*4882a593Smuzhiyun {
55*4882a593Smuzhiyun hvc_instantiate(0, 0, &hvc_sbi_ops);
56*4882a593Smuzhiyun
57*4882a593Smuzhiyun return 0;
58*4882a593Smuzhiyun }
59*4882a593Smuzhiyun console_initcall(hvc_sbi_console_init);
60