121 lines
3.3 KiB
C
121 lines
3.3 KiB
C
/*
|
|
* Copyright (c) 2019 omSquare s.r.o.
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
#include <drivers/uart.h>
|
|
#include <SEGGER_RTT.h>
|
|
|
|
struct uart_rtt_config {
|
|
void *up_buffer;
|
|
size_t up_size;
|
|
void *down_buffer;
|
|
size_t down_size;
|
|
u8_t channel;
|
|
};
|
|
|
|
static inline const struct uart_rtt_config *get_dev_config(struct device *dev)
|
|
{
|
|
return dev->config->config_info;
|
|
}
|
|
|
|
static int uart_rtt_init(struct device *dev)
|
|
{
|
|
/*
|
|
* Channel 0 is initialized at compile-time, Kconfig ensures that
|
|
* it is configured in correct, non-blocking mode. Other channels
|
|
* need to be configured at run-time.
|
|
*/
|
|
if (get_dev_config(dev)) {
|
|
const struct uart_rtt_config *cfg = get_dev_config(dev);
|
|
|
|
SEGGER_RTT_ConfigUpBuffer(cfg->channel, dev->config->name,
|
|
cfg->up_buffer, cfg->up_size,
|
|
SEGGER_RTT_MODE_NO_BLOCK_SKIP);
|
|
SEGGER_RTT_ConfigDownBuffer(cfg->channel, dev->config->name,
|
|
cfg->down_buffer, cfg->down_size,
|
|
SEGGER_RTT_MODE_NO_BLOCK_SKIP);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* @brief Poll the device for input.
|
|
*
|
|
* @param dev UART device struct
|
|
* @param c Pointer to character
|
|
*
|
|
* @return 0 if a character arrived, -1 if the input buffer if empty.
|
|
*/
|
|
|
|
static int uart_rtt_poll_in(struct device *dev, unsigned char *c)
|
|
{
|
|
unsigned int ch =
|
|
get_dev_config(dev) ? get_dev_config(dev)->channel : 0;
|
|
unsigned int ret = SEGGER_RTT_Read(ch, c, 1);
|
|
|
|
return ret ? 0 : -1;
|
|
}
|
|
|
|
/**
|
|
* @brief Output a character in polled mode.
|
|
*
|
|
* @param dev UART device struct
|
|
* @param c Character to send
|
|
*/
|
|
static void uart_rtt_poll_out(struct device *dev, unsigned char c)
|
|
{
|
|
unsigned int ch =
|
|
get_dev_config(dev) ? get_dev_config(dev)->channel : 0;
|
|
|
|
SEGGER_RTT_Write(ch, &c, 1);
|
|
}
|
|
|
|
static const struct uart_driver_api uart_rtt_driver_api = {
|
|
.poll_in = uart_rtt_poll_in,
|
|
.poll_out = uart_rtt_poll_out,
|
|
};
|
|
|
|
#if CONFIG_UART_RTT_0
|
|
|
|
DEVICE_AND_API_INIT(uart_rtt0, "RTT_0", uart_rtt_init, NULL, NULL,
|
|
/* Initialize UART device after RTT init. */
|
|
PRE_KERNEL_2, CONFIG_KERNEL_INIT_PRIORITY_DEVICE,
|
|
&uart_rtt_driver_api);
|
|
|
|
#endif
|
|
|
|
#define UART_RTT_CHANNEL(n) \
|
|
static u8_t \
|
|
uart_rtt##n##_tx_buffer[CONFIG_UART_RTT_##n##_TX_BUFFER_SIZE]; \
|
|
static u8_t \
|
|
uart_rtt##n##_rx_buffer[CONFIG_UART_RTT_##n##_RX_BUFFER_SIZE]; \
|
|
\
|
|
static const char uart_rtt##n##_name[] = "RTT_" #n "\0"; \
|
|
\
|
|
static const struct uart_rtt_config uart_rtt##n##_config = { \
|
|
.channel = n, \
|
|
.up_buffer = uart_rtt##n##_tx_buffer, \
|
|
.up_size = sizeof(uart_rtt##n##_tx_buffer), \
|
|
.down_buffer = uart_rtt##n##_rx_buffer, \
|
|
.down_size = sizeof(uart_rtt##n##_rx_buffer), \
|
|
}; \
|
|
\
|
|
DEVICE_AND_API_INIT(uart_rtt##n, uart_rtt##n##_name, uart_rtt_init, \
|
|
NULL, &uart_rtt##n##_config, PRE_KERNEL_2, \
|
|
CONFIG_KERNEL_INIT_PRIORITY_DEVICE, \
|
|
&uart_rtt_driver_api)
|
|
|
|
#if CONFIG_UART_RTT_1
|
|
UART_RTT_CHANNEL(1);
|
|
#endif
|
|
|
|
#if CONFIG_UART_RTT_2
|
|
UART_RTT_CHANNEL(2);
|
|
#endif
|
|
|
|
#if CONFIG_UART_RTT_3
|
|
UART_RTT_CHANNEL(3);
|
|
#endif
|