Maarrk/tio
1
0
Fork 0
mirror of https://github.com/tio/tio.git synced 2026-05-01 14:57:59 +02:00
Code Issues Projects Releases 1 Packages Wiki Activity Actions

Poll on serial port read instead of delay.

Browse source
This commit is contained in:
HiFiPhile 2024-04-03 20:46:44 +02:00
parent c9f88a3079
commit 9ef3175875
1 changed files with 54 additions and 32 deletions
Download patch file Download diff file Expand all files Collapse all files

70
src/xymodem.c
View file

@ -17,6 +17,7 @@
#include <sys/types.h>
#include <sys/stat.h>
#include <sys/mman.h>
#include <sys/poll.h>
#include <termios.h>
#include "misc.h"
@ -63,6 +64,27 @@ static uint16_t crc16(const uint8_t *data, uint16_t size)
return crc;
}
static int serial_poll(int sio, void *data, size_t len, int timeout)
{
struct pollfd fds[1];
fds[0].fd = sio;
fds[0].events = POLLIN ;
int ret = 0;
/* Wait data available */
ret = poll(fds, 1, timeout);
if (ret < 0) {
return ret;
}
else if (ret > 0) {
if(fds[0].revents & POLLIN) {
return read(sio, data, len);
}
}
/* Timeout */
return ret;
}
static int xmodem_1k(int sio, const void *data, size_t len, int seq)
{
struct xpacket_1k packet;
@ -76,13 +98,13 @@ static int xmodem_1k(int sio, const void *data, size_t len, int seq)
while(1) {
if (key_hit)
return -1;
if (read(sio, &resp, 1) < 0) {
if (errno == EWOULDBLOCK) {
rc = serial_poll(sio, &resp, 1, 50);
if (rc == 0) {
if (resp == 'C') break;
if (resp == CAN) return ERR;
usleep(50000);
continue;
}
else if (rc < 0) {
perror("Read sync from serial failed");
return ERR;
}
@ -133,16 +155,14 @@ static int xmodem_1k(int sio, const void *data, size_t len, int seq)
for(int n=0; n < 20; n++) {
if (key_hit)
return ERR;
if (read(sio, &resp, 1) < 0) {
if (errno == EWOULDBLOCK) {
usleep(50000);
continue;
}
rc = serial_poll(sio, &resp, 1, 50);
if (rc < 0) {
perror("Read ack/nak from serial failed");
return ERR;
}
} else if(rc > 0) {
break;
}
}
/* Update "progress bar" */
switch (resp) {
@ -171,11 +191,13 @@ static int xmodem_1k(int sio, const void *data, size_t len, int seq)
return ERR;
}
write(STDOUT_FILENO, "|", 1);
usleep(1000000); /* 1 s timeout*/
if (read(sio, &resp, 1) < 0) {
if (errno == EWOULDBLOCK) continue;
/* 1s timeout */
rc = serial_poll(sio, &resp, 1, 1000);
if (rc < 0) {
perror("Read from serial failed");
return ERR;
} else if(rc == 0) {
continue;
}
if (resp == ACK || resp == CAN) {
write(STDOUT_FILENO, "\r\n", 2);
@ -198,13 +220,13 @@ static int xmodem(int sio, const void *data, size_t len)
while(1) {
if (key_hit)
return -1;
if (read(sio, &resp, 1) < 0) {
if (errno == EWOULDBLOCK) {
rc = serial_poll(sio, &resp, 1, 50);
if (rc == 0) {
if (resp == 'C') break;
if (resp == CAN) return ERR;
usleep(50000);
continue;
}
else if (rc < 0) {
perror("Read sync from serial failed");
return ERR;
}
@ -252,16 +274,14 @@ static int xmodem(int sio, const void *data, size_t len)
for(int n=0; n < 20; n++) {
if (key_hit)
return ERR;
if (read(sio, &resp, 1) < 0) {
if (errno == EWOULDBLOCK) {
usleep(50000);
continue;
}
rc = serial_poll(sio, &resp, 1, 50);
if (rc < 0) {
perror("Read ack/nak from serial failed");
return ERR;
}
} else if(rc > 0) {
break;
}
}
/* Update "progress bar" */
switch (resp) {
@ -290,11 +310,13 @@ static int xmodem(int sio, const void *data, size_t len)
return ERR;
}
write(STDOUT_FILENO, "|", 1);
usleep(1000000); /* 1 s timeout*/
if (read(sio, &resp, 1) < 0) {
if (errno == EWOULDBLOCK) continue;
/* 1s timeout */
rc = serial_poll(sio, &resp, 1, 1000);
if (rc < 0) {
perror("Read from serial failed");
return ERR;
} else if(rc == 0) {
continue;
}
if (resp == ACK || resp == CAN) {
write(STDOUT_FILENO, "\r\n", 2);