fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-17 04:43:35 +08:00
Code Issues Packages Projects Releases Wiki Activity

SBUS on Linux: replace termios with termios2 and add UNKNOWN UART WQ

Browse Source
This commit is contained in:
SalimTerryLi
2020-02-02 14:06:27 -05:00
committed by GitHub
parent c8a58c5c9d
commit e0abe7090e
3 changed files with 45 additions and 59 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/lib/rc/sbus.cpp
+42 -57
View File
@@ -41,7 +41,6 @@
#include <fcntl.h>
#include <unistd.h>
#include <termios.h>
#include <string.h>
#ifdef TIOCSSINGLEWIRE
@@ -58,7 +57,9 @@ using namespace time_literals;
#if defined(__PX4_LINUX)
#include <sys/ioctl.h>
#include <linux/serial_core.h>
#include <asm-generic/termbits.h>
#else
#include <termios.h>
#endif
#define SBUS_START_SYMBOL 0x0f
@@ -152,57 +153,41 @@ sbus_init(const char *device, bool singlewire)
int
sbus_config(int sbus_fd, bool singlewire)
{
#if defined(__PX4_LINUX)
struct termios options;
if (tcgetattr(sbus_fd, &options) != 0) {
return -1;
}
tcflush(sbus_fd, TCIFLUSH);
bzero(&options, sizeof(options));
options.c_cflag |= (CLOCAL | CREAD);
options.c_cflag &= ~CSIZE;
options.c_cflag |= CS8;
options.c_cflag |= PARENB;
options.c_cflag &= ~PARODD;
options.c_iflag |= INPCK;
options.c_cflag |= CSTOPB;
options.c_cc[VTIME] = 0;
options.c_cc[VMIN] = 0;
cfsetispeed(&options, B38400);
cfsetospeed(&options, B38400);
tcflush(sbus_fd, TCIFLUSH);
if ((tcsetattr(sbus_fd, TCSANOW, &options)) != 0) {
return -1;
}
int baud = 100000;
struct serial_struct serials;
if ((ioctl(sbus_fd, TIOCGSERIAL, &serials)) < 0) {
return -1;
}
serials.flags = ASYNC_SPD_CUST;
serials.custom_divisor = serials.baud_base / baud;
if ((ioctl(sbus_fd, TIOCSSERIAL, &serials)) < 0) {
return -1;
}
ioctl(sbus_fd, TIOCGSERIAL, &serials);
tcflush(sbus_fd, TCIFLUSH);
return 0;
#else
int ret = -1;
#if defined(__PX4_LINUX)
struct termios2 tio = {};
if (0 != ioctl(sbus_fd, TCGETS2, &tio)) {
return ret;
}
/**
* Setting serial port,8E2, non-blocking.100Kbps
*/
tio.c_iflag &= ~(IGNBRK | BRKINT | PARMRK | ISTRIP | INLCR | IGNCR | ICRNL
| IXON);
tio.c_iflag |= (INPCK | IGNPAR);
tio.c_oflag &= ~OPOST;
tio.c_lflag &= ~(ECHO | ECHONL | ICANON | ISIG | IEXTEN);
tio.c_cflag &= ~(CSIZE | CRTSCTS | PARODD | CBAUD);
/**
* use BOTHER to specify speed directly in c_[io]speed member
*/
tio.c_cflag |= (CS8 | CSTOPB | CLOCAL | PARENB | BOTHER | CREAD);
tio.c_ispeed = 100000;
tio.c_ospeed = 100000;
tio.c_cc[VMIN] = 25;
tio.c_cc[VTIME] = 0;
if (0 != ioctl(sbus_fd, TCSETS2, &tio)) {
return ret;
}
ret = 0;
#else
if (sbus_fd >= 0) {
struct termios t;
@@ -221,16 +206,16 @@ sbus_config(int sbus_fd, bool singlewire)
#endif
}
/* initialise the decoder */
partial_frame_count = 0;
last_rx_time = hrt_absolute_time();
sbus_frame_drops = 0;
ret = 0;
}
return ret;
#endif
/* initialise the decoder */
partial_frame_count = 0;
last_rx_time = hrt_absolute_time();
sbus_frame_drops = 0;
return ret;
}
void