mirror of
https://github.com/zephyrproject-rtos/zephyr
synced 2025-08-24 08:05:45 +00:00
4800266cc6
This patch fixes drain of data left in UART Rx fifo. uart_irq_tx_ready checks if Rx IRQ has been raised, but because Rx IRQ is disabled this won't work even if there are some data left in the UART buffers. So simply uart_fifo_read is used to discard the data that left in UART buffer. Change-Id: I17f145ba58640650bafd3602412fc75229f39664 Signed-off-by: Mariusz Skamra <mariusz.skamra@tieto.com>
104 lines
2.2 KiB
C
104 lines
2.2 KiB
C
/** @file
|
|
* @brief Pipe UART driver
|
|
*
|
|
* A pipe UART driver allowing application to handle all aspects of received
|
|
* protocol data.
|
|
*/
|
|
|
|
/*
|
|
* Copyright (c) 2015 Intel Corporation
|
|
*
|
|
* Licensed under the Apache License, Version 2.0 (the "License");
|
|
* you may not use this file except in compliance with the License.
|
|
* You may obtain a copy of the License at
|
|
*
|
|
* http://www.apache.org/licenses/LICENSE-2.0
|
|
*
|
|
* Unless required by applicable law or agreed to in writing, software
|
|
* distributed under the License is distributed on an "AS IS" BASIS,
|
|
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
|
* See the License for the specific language governing permissions and
|
|
* limitations under the License.
|
|
*/
|
|
|
|
#include <nanokernel.h>
|
|
|
|
#include <board.h>
|
|
#include <uart.h>
|
|
|
|
#include <console/uart_pipe.h>
|
|
#include <misc/printk.h>
|
|
|
|
static struct device *uart_pipe_dev;
|
|
|
|
static uint8_t *recv_buf;
|
|
static size_t recv_buf_len;
|
|
static uart_pipe_recv_cb app_cb;
|
|
static size_t recv_off;
|
|
|
|
static void uart_pipe_isr(struct device *unused)
|
|
{
|
|
ARG_UNUSED(unused);
|
|
|
|
while (uart_irq_update(uart_pipe_dev)
|
|
&& uart_irq_is_pending(uart_pipe_dev)) {
|
|
int rx;
|
|
|
|
if (!uart_irq_rx_ready(uart_pipe_dev)) {
|
|
continue;
|
|
}
|
|
|
|
rx = uart_fifo_read(uart_pipe_dev, recv_buf + recv_off,
|
|
recv_buf_len - recv_off);
|
|
if (!rx) {
|
|
continue;
|
|
}
|
|
|
|
/*
|
|
* Call application callback with received data. Application
|
|
* may provide new buffer or alter data offset.
|
|
*/
|
|
recv_off += rx;
|
|
recv_buf = app_cb(recv_buf, &recv_off);
|
|
}
|
|
}
|
|
|
|
int uart_pipe_send(const uint8_t *data, int len)
|
|
{
|
|
while (len--) {
|
|
uart_poll_out(uart_pipe_dev, *data++);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void uart_pipe_setup(struct device *uart)
|
|
{
|
|
uint8_t c;
|
|
|
|
uart_irq_rx_disable(uart);
|
|
uart_irq_tx_disable(uart);
|
|
|
|
/* Drain the fifo */
|
|
while (uart_fifo_read(uart, &c, 1)) {
|
|
continue;
|
|
}
|
|
|
|
uart_irq_callback_set(uart, uart_pipe_isr);
|
|
|
|
uart_irq_rx_enable(uart);
|
|
}
|
|
|
|
void uart_pipe_register(uint8_t *buf, size_t len, uart_pipe_recv_cb cb)
|
|
{
|
|
recv_buf = buf;
|
|
recv_buf_len = len;
|
|
app_cb = cb;
|
|
|
|
uart_pipe_dev = device_get_binding(CONFIG_UART_PIPE_ON_DEV_NAME);
|
|
|
|
if (uart_pipe_dev != NULL) {
|
|
uart_pipe_setup(uart_pipe_dev);
|
|
}
|
|
}
|