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