AP_HAL_Linux: got rid of TCP connection
This commit is contained in:
parent
179fc4a781
commit
595903f17c
@ -34,8 +34,6 @@ using namespace Linux;
|
|||||||
|
|
||||||
LinuxUARTDriver::LinuxUARTDriver(bool default_console) :
|
LinuxUARTDriver::LinuxUARTDriver(bool default_console) :
|
||||||
device_path(NULL),
|
device_path(NULL),
|
||||||
_rd_fd(-1),
|
|
||||||
_wr_fd(-1),
|
|
||||||
_packetise(false),
|
_packetise(false),
|
||||||
_flow_control(FLOW_CONTROL_DISABLE)
|
_flow_control(FLOW_CONTROL_DISABLE)
|
||||||
{
|
{
|
||||||
@ -77,21 +75,7 @@ void LinuxUARTDriver::begin(uint32_t b, uint16_t rxS, uint16_t txS)
|
|||||||
case DEVICE_TCP:
|
case DEVICE_TCP:
|
||||||
{
|
{
|
||||||
_connected = false;
|
_connected = false;
|
||||||
if (_flag != NULL){
|
::fprintf(stderr, "Please, use UDP instead\n");
|
||||||
if (!strcmp(_flag, "wait")){
|
|
||||||
_tcp_start_connection(true);
|
|
||||||
} else {
|
|
||||||
_tcp_start_connection(false);
|
|
||||||
}
|
|
||||||
} else {
|
|
||||||
_tcp_start_connection(false);
|
|
||||||
}
|
|
||||||
|
|
||||||
if (!_connected) {
|
|
||||||
::printf("LinuxUARTDriver TCP connection not established\n");
|
|
||||||
exit(1);
|
|
||||||
}
|
|
||||||
_flow_control = FLOW_CONTROL_ENABLE;
|
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -256,112 +240,6 @@ bool LinuxUARTDriver::_serial_start_connection()
|
|||||||
return true;
|
return true;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
/*
|
|
||||||
start a TCP connection for the serial port. If wait_for_connection
|
|
||||||
is true then block until a client connects
|
|
||||||
*/
|
|
||||||
void LinuxUARTDriver::_tcp_start_connection(bool wait_for_connection)
|
|
||||||
{
|
|
||||||
int one=1;
|
|
||||||
struct sockaddr_in sockaddr;
|
|
||||||
int ret;
|
|
||||||
int listen_fd = -1; // socket we are listening on
|
|
||||||
int net_fd = -1; // network file descriptor, will be linked to wr_fd and rd_fd
|
|
||||||
uint8_t portNumber = 0; // connecto to _base_port + portNumber
|
|
||||||
|
|
||||||
if (net_fd != -1) {
|
|
||||||
close(net_fd);
|
|
||||||
}
|
|
||||||
|
|
||||||
if (listen_fd == -1) {
|
|
||||||
memset(&sockaddr,0,sizeof(sockaddr));
|
|
||||||
|
|
||||||
#ifdef HAVE_SOCK_SIN_LEN
|
|
||||||
sockaddr.sin_len = sizeof(sockaddr);
|
|
||||||
#endif
|
|
||||||
sockaddr.sin_port = htons(_base_port + portNumber);
|
|
||||||
sockaddr.sin_family = AF_INET;
|
|
||||||
if (strcmp(_ip, "*") == 0) {
|
|
||||||
// Bind to all interfaces
|
|
||||||
sockaddr.sin_addr.s_addr = htonl(INADDR_ANY);
|
|
||||||
} else {
|
|
||||||
sockaddr.sin_addr.s_addr = inet_addr(_ip);
|
|
||||||
}
|
|
||||||
|
|
||||||
listen_fd = socket(AF_INET, SOCK_STREAM, 0);
|
|
||||||
if (listen_fd == -1) {
|
|
||||||
::printf("socket failed - %s\n", strerror(errno));
|
|
||||||
exit(1);
|
|
||||||
}
|
|
||||||
|
|
||||||
/* we want to be able to re-use ports quickly */
|
|
||||||
setsockopt(listen_fd, SOL_SOCKET, SO_REUSEADDR, &one, sizeof(one));
|
|
||||||
|
|
||||||
if (!wait_for_connection) {
|
|
||||||
|
|
||||||
ret = connect(listen_fd, (struct sockaddr *)&sockaddr, sizeof(sockaddr));
|
|
||||||
|
|
||||||
if (ret < 0) {
|
|
||||||
::printf("connect failed on port %u - %s\n",
|
|
||||||
(unsigned)ntohs(sockaddr.sin_port),
|
|
||||||
strerror(errno));
|
|
||||||
exit(1);
|
|
||||||
}
|
|
||||||
|
|
||||||
fcntl(listen_fd, F_SETFL, fcntl(listen_fd, F_GETFL, 0) | O_NONBLOCK);
|
|
||||||
|
|
||||||
_rd_fd = listen_fd;
|
|
||||||
|
|
||||||
_connected = true;
|
|
||||||
|
|
||||||
::printf("Serial port %u on TCP port %u\n", portNumber,
|
|
||||||
_base_port + portNumber);
|
|
||||||
fflush(stdout);
|
|
||||||
|
|
||||||
} else {
|
|
||||||
|
|
||||||
ret = bind(listen_fd, (struct sockaddr *)&sockaddr, sizeof(sockaddr));
|
|
||||||
if (ret == -1) {
|
|
||||||
::printf("bind failed on port %u - %s\n",
|
|
||||||
(unsigned)ntohs(sockaddr.sin_port),
|
|
||||||
strerror(errno));
|
|
||||||
exit(1);
|
|
||||||
}
|
|
||||||
|
|
||||||
ret = listen(listen_fd, 5);
|
|
||||||
if (ret == -1) {
|
|
||||||
::printf("listen failed - %s\n", strerror(errno));
|
|
||||||
exit(1);
|
|
||||||
}
|
|
||||||
|
|
||||||
::printf("Serial port %u on TCP port %u\n", portNumber,
|
|
||||||
_base_port + portNumber);
|
|
||||||
::fflush(stdout);
|
|
||||||
|
|
||||||
::printf("Waiting for connection ....\n");
|
|
||||||
::fflush(stdout);
|
|
||||||
net_fd = accept(listen_fd, NULL, NULL);
|
|
||||||
if (net_fd == -1) {
|
|
||||||
::printf("accept() error - %s", strerror(errno));
|
|
||||||
exit(1);
|
|
||||||
}
|
|
||||||
setsockopt(net_fd, SOL_SOCKET, SO_REUSEADDR, &one, sizeof(one));
|
|
||||||
setsockopt(net_fd, IPPROTO_TCP, TCP_NODELAY, &one, sizeof(one));
|
|
||||||
|
|
||||||
// always run the file descriptor non-blocking, and deal with |
|
|
||||||
// blocking IO in the higher level calls
|
|
||||||
fcntl(net_fd, F_SETFL, fcntl(net_fd, F_GETFL, 0) | O_NONBLOCK);
|
|
||||||
|
|
||||||
_connected = true;
|
|
||||||
_rd_fd = net_fd;
|
|
||||||
_wr_fd = net_fd;
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
/*
|
/*
|
||||||
start a UDP connection for the serial port
|
start a UDP connection for the serial port
|
||||||
*/
|
*/
|
||||||
|
@ -35,8 +35,6 @@ public:
|
|||||||
|
|
||||||
private:
|
private:
|
||||||
SerialDevice *_device = nullptr;
|
SerialDevice *_device = nullptr;
|
||||||
int _rd_fd;
|
|
||||||
int _wr_fd;
|
|
||||||
bool _nonblocking_writes;
|
bool _nonblocking_writes;
|
||||||
bool _console;
|
bool _console;
|
||||||
volatile bool _in_timer;
|
volatile bool _in_timer;
|
||||||
@ -49,7 +47,6 @@ private:
|
|||||||
|
|
||||||
void _allocate_buffers(uint16_t rxS, uint16_t txS);
|
void _allocate_buffers(uint16_t rxS, uint16_t txS);
|
||||||
void _deallocate_buffers();
|
void _deallocate_buffers();
|
||||||
void _tcp_start_connection(bool wait_for_connection);
|
|
||||||
void _udp_start_connection(void);
|
void _udp_start_connection(void);
|
||||||
bool _serial_start_connection(void);
|
bool _serial_start_connection(void);
|
||||||
|
|
||||||
|
Loading…
Reference in New Issue
Block a user