forked from zephyrproject-rtos/zephyr
-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathgetchar.c
79 lines (61 loc) · 1.56 KB
/
getchar.c
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
/*
* Copyright (c) 2017 Linaro Limited.
*
* SPDX-License-Identifier: Apache-2.0
*/
#include <zephyr/kernel.h>
#include <zephyr/device.h>
#include <zephyr/console/console.h>
#include <zephyr/console/tty.h>
#include <zephyr/drivers/uart.h>
static struct tty_serial console_serial;
static uint8_t console_rxbuf[CONFIG_CONSOLE_GETCHAR_BUFSIZE];
static uint8_t console_txbuf[CONFIG_CONSOLE_PUTCHAR_BUFSIZE];
ssize_t console_write(void *dummy, const void *buf, size_t size)
{
ARG_UNUSED(dummy);
return tty_write(&console_serial, buf, size);
}
ssize_t console_read(void *dummy, void *buf, size_t size)
{
ARG_UNUSED(dummy);
return tty_read(&console_serial, buf, size);
}
int console_putchar(char c)
{
return tty_write(&console_serial, &c, 1);
}
int console_getchar(void)
{
uint8_t c;
int res;
res = tty_read(&console_serial, &c, 1);
if (res < 0) {
return res;
}
return c;
}
int console_init(void)
{
const struct device *uart_dev;
int ret;
uart_dev = DEVICE_DT_GET(DT_CHOSEN(zephyr_console));
if (!device_is_ready(uart_dev)) {
return -ENODEV;
}
ret = tty_init(&console_serial, uart_dev);
if (ret) {
return ret;
}
/* Checks device driver supports for interrupt driven data transfers. */
if (CONFIG_CONSOLE_GETCHAR_BUFSIZE + CONFIG_CONSOLE_PUTCHAR_BUFSIZE) {
const struct uart_driver_api *api =
(const struct uart_driver_api *)uart_dev->api;
if (!api->irq_callback_set) {
return -ENOTSUP;
}
}
tty_set_tx_buf(&console_serial, console_txbuf, sizeof(console_txbuf));
tty_set_rx_buf(&console_serial, console_rxbuf, sizeof(console_rxbuf));
return 0;
}