yemai/bizhang_-obav
1
0
Fork 0
mirror of https://gitee.com/xiaohuolufeihua/bizhang_-obav.git synced 2026-05-21 09:22:18 +00:00
Code Issues Packages Projects Releases Wiki Activity

Merge pull request #2203 from NaterGator/mavlink_usbfix

Browse Source 
Fix MAVLink USB UART detection
This commit is contained in:
Lorenz Meier
2015-05-26 23:22:27 -07:00
parent 7c5af64580 b55361b472
commit a14b020d63
2 changed files with 6 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files

8
src/modules/mavlink/mavlink_main.cpp
View File

@@ -577,7 +577,7 @@ int Mavlink::get_component_id()
}
#ifndef __PX4_POSIX
int Mavlink::mavlink_open_uart(int baud, const char *uart_name, struct termios *uart_config_original, bool *is_usb)
int Mavlink::mavlink_open_uart(int baud, const char *uart_name, struct termios *uart_config_original)
{
/* process baud rate */
int speed;
@@ -642,7 +642,7 @@ int Mavlink::mavlink_open_uart(int baud, const char *uart_name, struct termios *
/* Try to set baud rate */
struct termios uart_config;
int termios_state;
*is_usb = false;
_is_usb_uart = false;
/* Back up the original uart configuration to restore it after exit */
if ((termios_state = tcgetattr(_uart_fd, uart_config_original)) < 0) {
@@ -667,6 +667,8 @@ int Mavlink::mavlink_open_uart(int baud, const char *uart_name, struct termios *
return -1;
}
} else {
_is_usb_uart = true;
}
if ((termios_state = tcsetattr(_uart_fd, TCSANOW, &uart_config)) < 0) {
@@ -1393,7 +1395,7 @@ Mavlink::task_main(int argc, char *argv[])
struct termios uart_config_original;
/* default values for arguments */
_uart_fd = mavlink_open_uart(_baudrate, _device_name, &uart_config_original, &_is_usb_uart);
_uart_fd = mavlink_open_uart(_baudrate, _device_name, &uart_config_original);
if (_uart_fd < 0) {
warn("could not open %s", _device_name);

2
src/modules/mavlink/mavlink_main.h
View File

@@ -388,7 +388,7 @@ private:
void mavlink_update_system();
#ifndef __PX4_QURT
int mavlink_open_uart(int baudrate, const char *uart_name, struct termios *uart_config_original, bool *is_usb);
int mavlink_open_uart(int baudrate, const char *uart_name, struct termios *uart_config_original);
#endif
static unsigned int interval_from_rate(float rate);