native: add UART driver based on /dev/tty
uart0 functionality is removed by #3164. This patch implements periph/uart, rather than deprecated uart0, using /dev/tty. To use with netdev2_tap simultaneously, this patch adds asynchronus read system and modifies netdev2_tap to use it. A TTY device is specified on command line with -c (COM) option, since -t was used by the old implementation. This patch also implements empty GPIO driver needed by the xbee driver.pr/gpio
Yonezawa-T2
7 years ago
parent
4f17d2bd9c
commit
79d33897cb
@ -0,0 +1,160 @@
|
||||
/**
|
||||
* Multiple asynchronus read on file descriptors
|
||||
*
|
||||
* Copyright (C) 2015 Ludwig Knüpfer <ludwig.knuepfer@fu-berlin.de>,
|
||||
* Martine Lenders <mlenders@inf.fu-berlin.de>
|
||||
* Kaspar Schleiser <kaspar@schleiser.de>
|
||||
* Ell-i open source co-operative
|
||||
* Takuo Yonezawa <Yonezawa-T2@mail.dnp.co.jp>
|
||||
*
|
||||
* This file is subject to the terms and conditions of the GNU Lesser
|
||||
* General Public License v2.1. See the file LICENSE in the top level
|
||||
* directory for more details.
|
||||
*
|
||||
* @ingroup native_cpu
|
||||
* @{
|
||||
* @file
|
||||
* @author Takuo Yonezawa <Yonezawa-T2@mail.dnp.co.jp>
|
||||
*/
|
||||
|
||||
#include <err.h>
|
||||
#include <signal.h>
|
||||
#include <stdlib.h>
|
||||
#include <unistd.h>
|
||||
#include <fcntl.h>
|
||||
|
||||
#include "async_read.h"
|
||||
#include "native_internal.h"
|
||||
|
||||
static int _next_index;
|
||||
static int _fds[ASYNC_READ_NUMOF];
|
||||
static native_async_read_callback_t _native_async_read_callbacks[ASYNC_READ_NUMOF];
|
||||
|
||||
#ifdef __MACH__
|
||||
static pid_t _sigio_child_pids[ASYNC_READ_NUMOF];
|
||||
static void _sigio_child(int fd);
|
||||
#endif
|
||||
|
||||
static void _async_io_isr(void) {
|
||||
fd_set rfds;
|
||||
|
||||
FD_ZERO(&rfds);
|
||||
|
||||
int max_fd = 0;
|
||||
|
||||
for (int i = 0; i < _next_index; i++) {
|
||||
FD_SET(_fds[i], &rfds);
|
||||
|
||||
if (max_fd < _fds[i]) {
|
||||
max_fd = _fds[i];
|
||||
}
|
||||
}
|
||||
|
||||
if (real_select(max_fd + 1, &rfds, NULL, NULL, NULL) > 0) {
|
||||
for (int i = 0; i < _next_index; i++) {
|
||||
if (FD_ISSET(_fds[i], &rfds)) {
|
||||
_native_async_read_callbacks[i](_fds[i]);
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
void native_async_read_setup(void) {
|
||||
register_interrupt(SIGIO, _async_io_isr);
|
||||
}
|
||||
|
||||
void native_async_read_cleanup(void) {
|
||||
unregister_interrupt(SIGIO);
|
||||
|
||||
#ifdef __MACH__
|
||||
for (int i = 0; i < _next_index; i++) {
|
||||
kill(_sigio_child_pids[i], SIGKILL);
|
||||
}
|
||||
#endif
|
||||
}
|
||||
|
||||
void native_async_read_continue(int fd) {
|
||||
(void) fd;
|
||||
#ifdef __MACH__
|
||||
for (int i = 0; i < _next_index; i++) {
|
||||
if (_fds[i] == fd) {
|
||||
kill(_sigio_child_pids[i], SIGCONT);
|
||||
}
|
||||
}
|
||||
#endif
|
||||
}
|
||||
|
||||
void native_async_read_add_handler(int fd, native_async_read_callback_t handler) {
|
||||
if (_next_index >= ASYNC_READ_NUMOF) {
|
||||
err(EXIT_FAILURE, "native_async_read_add_handler(): too many callbacks");
|
||||
}
|
||||
|
||||
_fds[_next_index] = fd;
|
||||
_native_async_read_callbacks[_next_index] = handler;
|
||||
|
||||
#ifdef __MACH__
|
||||
/* tuntap signalled IO is not working in OSX,
|
||||
* * check http://sourceforge.net/p/tuntaposx/bugs/17/ */
|
||||
_sigio_child(_next_index);
|
||||
#else
|
||||
/* configure fds to send signals on io */
|
||||
if (fcntl(fd, F_SETOWN, _native_pid) == -1) {
|
||||
err(EXIT_FAILURE, "native_async_read_add_handler(): fcntl(F_SETOWN)");
|
||||
}
|
||||
/* set file access mode to non-blocking */
|
||||
if (fcntl(fd, F_SETFL, O_NONBLOCK | O_ASYNC) == -1) {
|
||||
err(EXIT_FAILURE, "native_async_read_add_handler(): fcntl(F_SETFL)");
|
||||
}
|
||||
#endif /* not OSX */
|
||||
|
||||
_next_index++;
|
||||
}
|
||||
|
||||
#ifdef __MACH__
|
||||
static void _sigio_child(int index)
|
||||
{
|
||||
int fd = _fds[index];
|
||||
pid_t parent = _native_pid;
|
||||
pid_t child;
|
||||
if ((child = real_fork()) == -1) {
|
||||
err(EXIT_FAILURE, "sigio_child: fork");
|
||||
}
|
||||
if (child > 0) {
|
||||
_sigio_child_pids[index] = child;
|
||||
|
||||
/* return in parent process */
|
||||
return;
|
||||
}
|
||||
|
||||
sigset_t sigmask;
|
||||
|
||||
sigemptyset(&sigmask);
|
||||
sigaddset(&sigmask, SIGCONT);
|
||||
sigprocmask(SIG_BLOCK, &sigmask, NULL);
|
||||
|
||||
/* watch tap interface and signal parent process if data is
|
||||
* available */
|
||||
fd_set rfds;
|
||||
while (1) {
|
||||
FD_ZERO(&rfds);
|
||||
FD_SET(fd, &rfds);
|
||||
if (real_select(fd + 1, &rfds, NULL, NULL, NULL) == 1) {
|
||||
kill(parent, SIGIO);
|
||||
}
|
||||
else {
|
||||
kill(parent, SIGKILL);
|
||||
err(EXIT_FAILURE, "osx_sigio_child: select");
|
||||
}
|
||||
|
||||
/* If SIGCONT is sent before calling pause(), the process stops
|
||||
* forever, so using sigwait instead. */
|
||||
|
||||
int sig;
|
||||
|
||||
sigemptyset(&sigmask);
|
||||
sigaddset(&sigmask, SIGCONT);
|
||||
sigwait(&sigmask, &sig);
|
||||
}
|
||||
}
|
||||
#endif
|
||||
/** @} */
|
||||
@ -0,0 +1,74 @@
|
||||
/*
|
||||
* Copyright (C) 2015 Takuo Yonezawa <Yonezawa-T2@mail.dnp.co.jp>
|
||||
*
|
||||
* This file is subject to the terms and conditions of the GNU Lesser General
|
||||
* Public License v2.1. See the file LICENSE in the top level directory for
|
||||
* more details.
|
||||
*/
|
||||
|
||||
/**
|
||||
* @ingroup native_cpu
|
||||
* @{
|
||||
*
|
||||
* @file
|
||||
* @brief Multiple asynchronus read on file descriptors
|
||||
*
|
||||
* @author Takuo Yonezawa <Yonezawa-T2@mail.dnp.co.jp>
|
||||
*/
|
||||
#ifndef ASYNC_READ_H
|
||||
#define ASYNC_READ_H
|
||||
|
||||
#ifdef __cplusplus
|
||||
extern "C" {
|
||||
#endif
|
||||
|
||||
/**
|
||||
* @brief Maximum number of file descriptors
|
||||
*/
|
||||
#ifndef ASYNC_READ_NUMOF
|
||||
#define ASYNC_READ_NUMOF 2
|
||||
#endif
|
||||
|
||||
/**
|
||||
* @brief asynchronus read callback type
|
||||
*/
|
||||
typedef void (*native_async_read_callback_t)(int fd);
|
||||
|
||||
/**
|
||||
* @brief initialize asynchronus read system
|
||||
*
|
||||
* This registers SIGIO signal handler.
|
||||
*/
|
||||
void native_async_read_setup(void);
|
||||
|
||||
/**
|
||||
* @brief shutdown asynchronus read system
|
||||
*
|
||||
* This deregisters SIGIO signal handler.
|
||||
*/
|
||||
void native_async_read_cleanup(void);
|
||||
|
||||
/**
|
||||
* @brief resume monitoring of file descriptors
|
||||
*
|
||||
* Call this function after reading file descriptors.
|
||||
*
|
||||
* @param[in] fd The file descriptor to monitor
|
||||
*/
|
||||
void native_async_read_continue(int fd);
|
||||
|
||||
/**
|
||||
* @brief start monitoring of file descriptor
|
||||
*
|
||||
* @param[in] fd The file descriptor to monitor
|
||||
* @param[in] handler The callback function to be called when the file
|
||||
* descriptor is ready to read.
|
||||
*/
|
||||
void native_async_read_add_handler(int fd, native_async_read_callback_t handler);
|
||||
|
||||
#ifdef __cplusplus
|
||||
}
|
||||
#endif
|
||||
|
||||
#endif
|
||||
/** @} */
|
||||
@ -0,0 +1,46 @@
|
||||
/*
|
||||
* Copyright (C) 2015 Takuo Yonezawa <Yonezawa-T2@mail.dnp.co.jp>
|
||||
*
|
||||
* This file is subject to the terms and conditions of the GNU Lesser General
|
||||
* Public License v2.1. See the file LICENSE in the top level directory for
|
||||
* more details.
|
||||
*/
|
||||
|
||||
/**
|
||||
* @ingroup native_cpu
|
||||
* @{
|
||||
*
|
||||
* @file
|
||||
* @brief UART implementation based on /dev/tty devices on host
|
||||
*
|
||||
* @author Takuo Yonezawa <Yonezawa-T2@mail.dnp.co.jp>
|
||||
*/
|
||||
|
||||
#ifndef TTY_UART_H
|
||||
#define TTY_UART_H
|
||||
|
||||
#include "periph/uart.h"
|
||||
|
||||
#ifdef __cplusplus
|
||||
extern "C" {
|
||||
#endif
|
||||
|
||||
/**
|
||||
* @brief register /dev/tty device to be used for UART
|
||||
*
|
||||
* @param[in] uart UART id
|
||||
* @param[in] name path name for /dev/tty device
|
||||
*/
|
||||
void tty_uart_setup(uart_t uart, const char *name);
|
||||
|
||||
/**
|
||||
* @brief closes files opened
|
||||
*/
|
||||
void uart_cleanup(void);
|
||||
|
||||
#ifdef __cplusplus
|
||||
}
|
||||
#endif
|
||||
|
||||
#endif
|
||||
/** @} */
|
||||
@ -0,0 +1,69 @@
|
||||
/*
|
||||
* Copyright (C) 2015 Takuo Yonezawa <Yonezawa-T2@mail.dnp.co.jp>
|
||||
*
|
||||
* This file is subject to the terms and conditions of the GNU Lesser General
|
||||
* Public License v2.1. See the file LICENSE in the top level directory for
|
||||
* more details.
|
||||
*/
|
||||
|
||||
/**
|
||||
* @ingroup native_cpu
|
||||
* @{
|
||||
*
|
||||
* @file
|
||||
* @brief empty GPIO implementation
|
||||
*
|
||||
* @author Takuo Yonezawa <Yonezawa-T2@mail.dnp.co.jp>
|
||||
*/
|
||||
|
||||
#include "periph/gpio.h"
|
||||
|
||||
int gpio_init(gpio_t pin, gpio_mode_t mode) {
|
||||
(void) pin;
|
||||
(void) mode;
|
||||
|
||||
return -1;
|
||||
}
|
||||
|
||||
int gpio_init_int(gpio_t pin, gpio_mode_t mode, gpio_flank_t flank,
|
||||
gpio_cb_t cb, void *arg){
|
||||
(void) pin;
|
||||
(void) mode;
|
||||
(void) flank;
|
||||
(void) cb;
|
||||
(void) arg;
|
||||
|
||||
return -1;
|
||||
}
|
||||
|
||||
void gpio_irq_enable(gpio_t pin) {
|
||||
(void) pin;
|
||||
}
|
||||
|
||||
void gpio_irq_disable(gpio_t pin) {
|
||||
(void) pin;
|
||||
}
|
||||
|
||||
int gpio_read(gpio_t pin) {
|
||||
(void) pin;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
void gpio_set(gpio_t pin) {
|
||||
(void) pin;
|
||||
}
|
||||
|
||||
void gpio_clear(gpio_t pin) {
|
||||
(void) pin;
|
||||
}
|
||||
|
||||
void gpio_toggle(gpio_t pin) {
|
||||
(void) pin;
|
||||
}
|
||||
|
||||
void gpio_write(gpio_t pin, int value) {
|
||||
(void) pin;
|
||||
(void) value;
|
||||
}
|
||||
/** @} */
|
||||
@ -0,0 +1,187 @@
|
||||
/*
|
||||
* Copyright (C) 2015 Takuo Yonezawa <Yonezawa-T2@mail.dnp.co.jp>
|
||||
*
|
||||
* This file is subject to the terms and conditions of the GNU Lesser General
|
||||
* Public License v2.1. See the file LICENSE in the top level directory for
|
||||
* more details.
|
||||
*/
|
||||
|
||||
/**
|
||||
* @ingroup native_cpu
|
||||
* @{
|
||||
*
|
||||
* @file
|
||||
* @brief UART implementation based on /dev/tty devices on host
|
||||
*
|
||||
* @author Takuo Yonezawa <Yonezawa-T2@mail.dnp.co.jp>
|
||||
*/
|
||||
|
||||
#include <errno.h>
|
||||
#include <fcntl.h>
|
||||
#include <limits.h>
|
||||
#include <string.h>
|
||||
#include <termios.h>
|
||||
#include <fcntl.h>
|
||||
|
||||
#include "thread.h"
|
||||
#include "periph/uart.h"
|
||||
#include "native_internal.h"
|
||||
#include "async_read.h"
|
||||
|
||||
#define ENABLE_DEBUG (0)
|
||||
#include "debug.h"
|
||||
|
||||
/**
|
||||
* @brief callback function and its argument
|
||||
*/
|
||||
static uart_isr_ctx_t uart_config[UART_NUMOF];
|
||||
|
||||
/**
|
||||
* @brief filenames of /dev/tty
|
||||
*/
|
||||
static char *tty_device_filenames[UART_NUMOF];
|
||||
|
||||
/**
|
||||
* @brief file descriptors of /dev/tty
|
||||
*/
|
||||
static int tty_fds[UART_NUMOF];
|
||||
|
||||
void tty_uart_setup(uart_t uart, const char *filename)
|
||||
{
|
||||
tty_device_filenames[uart] = strndup(filename, PATH_MAX - 1);
|
||||
}
|
||||
|
||||
static void io_signal_handler(int fd)
|
||||
{
|
||||
uart_t uart;
|
||||
|
||||
for (uart = 0; uart < UART_NUMOF; uart++) {
|
||||
if (tty_fds[uart] == fd) {
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
int is_first = 1;
|
||||
|
||||
while (1) {
|
||||
char c;
|
||||
int status = real_read(fd, &c, 1);
|
||||
|
||||
if (status == 1) {
|
||||
if (is_first) {
|
||||
is_first = 0;
|
||||
DEBUG("read char from serial port");
|
||||
}
|
||||
|
||||
DEBUG(" %02x", (unsigned char) c);
|
||||
|
||||
uart_config[uart].rx_cb(uart_config[uart].arg, c);
|
||||
} else {
|
||||
if (status == -1 && errno != EAGAIN) {
|
||||
DEBUG("error: cannot read from serial port\n");
|
||||
|
||||
uart_config[uart].rx_cb = NULL;
|
||||
}
|
||||
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
if (!is_first) {
|
||||
DEBUG("\n");
|
||||
}
|
||||
|
||||
native_async_read_continue(fd);
|
||||
}
|
||||
|
||||
int uart_init(uart_t uart, uint32_t baudrate, uart_rx_cb_t rx_cb, void *arg)
|
||||
{
|
||||
if (uart >= UART_NUMOF) {
|
||||
return -1;
|
||||
}
|
||||
|
||||
struct termios termios;
|
||||
|
||||
memset(&termios, 0, sizeof(termios));
|
||||
|
||||
termios.c_iflag = 0;
|
||||
termios.c_oflag = 0;
|
||||
termios.c_cflag = CS8 | CREAD | CLOCAL;
|
||||
termios.c_lflag = 0;
|
||||
|
||||
speed_t speed;
|
||||
|
||||
switch (baudrate) {
|
||||
case 0: speed = B0; break;
|
||||
case 50: speed = B50; break;
|
||||
case 75: speed = B75; break;
|
||||
case 110: speed = B110; break;
|
||||
case 134: speed = B134; break;
|
||||
case 150: speed = B150; break;
|
||||
case 200: speed = B200; break;
|
||||
case 300: speed = B300; break;
|
||||
case 600: speed = B600; break;
|
||||
case 1200: speed = B1200; break;
|
||||
case 1800: speed = B1800; break;
|
||||
case 2400: speed = B2400; break;
|
||||
case 4800: speed = B4800; break;
|
||||
case 9600: speed = B9600; break;
|
||||
case 19200: speed = B19200; break;
|
||||
case 38400: speed = B38400; break;
|
||||
case 57600: speed = B57600; break;
|
||||
case 115200: speed = B115200; break;
|
||||
case 230400: speed = B230400 ; break;
|
||||
default:
|
||||
return -1;
|
||||
break;
|
||||
}
|
||||
|
||||
cfsetospeed(&termios, speed);
|
||||
cfsetispeed(&termios, speed);
|
||||
|
||||
tty_fds[uart] = real_open(tty_device_filenames[uart], O_RDWR | O_NONBLOCK);
|
||||
|
||||
if (tty_fds[uart] < 0) {
|
||||
return -3;
|
||||
}
|
||||
|
||||
tcsetattr(tty_fds[uart], TCSANOW, &termios);
|
||||
|
||||
uart_config[uart].rx_cb = rx_cb;
|
||||
uart_config[uart].arg = arg;
|
||||
|
||||
native_async_read_setup();
|
||||
native_async_read_add_handler(tty_fds[uart], io_signal_handler);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
void uart_write(uart_t uart, const uint8_t *data, size_t len)
|
||||
{
|
||||
DEBUG("writing to serial port ");
|
||||
|
||||
#if ENABLE_DEBUG
|
||||
for (size_t i = 0; i < len; i++) {
|
||||
DEBUG("%02x ", (unsigned char) data[i]);
|
||||
}
|
||||
for (size_t i = 0; i < len; i++) {
|
||||
DEBUG("%c", (char) data[i]);
|
||||
}
|
||||
#endif
|
||||
|
||||
DEBUG("\n");
|
||||
|
||||
_native_write(tty_fds[uart], data, len);
|
||||
}
|
||||
|
||||
void uart_cleanup(void) {
|
||||
native_async_read_cleanup();
|
||||
|
||||
for (uart_t uart = 0; uart < UART_NUMOF; uart++) {
|
||||
if (uart_config[uart].rx_cb != NULL) {
|
||||
real_close(tty_fds[uart]);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
/** @} */
|
||||
Loading…
Reference in New Issue