Merge pull request #1048 from cmorty/pull/serialdump
Fix and clean up serialdump.c
This commit is contained in:
commit
f45c6ad1b0
|
@ -22,4 +22,4 @@ endif
|
||||||
all: $(SERIALDUMP)
|
all: $(SERIALDUMP)
|
||||||
|
|
||||||
$(SERIALDUMP): serialdump.c
|
$(SERIALDUMP): serialdump.c
|
||||||
$(CC) -o $@ $<
|
$(CC) -O2 -o $@ $<
|
||||||
|
|
Binary file not shown.
|
@ -1,3 +1,4 @@
|
||||||
|
#define _GNU_SOURCE
|
||||||
#include <stdio.h>
|
#include <stdio.h>
|
||||||
#include <fcntl.h>
|
#include <fcntl.h>
|
||||||
#include <termios.h>
|
#include <termios.h>
|
||||||
|
@ -6,9 +7,10 @@
|
||||||
#include <sys/time.h>
|
#include <sys/time.h>
|
||||||
#include <stdlib.h>
|
#include <stdlib.h>
|
||||||
#include <string.h>
|
#include <string.h>
|
||||||
|
#include <time.h>
|
||||||
|
|
||||||
#define BAUDRATE B57600
|
#define BAUDRATE B115200
|
||||||
#define BAUDRATE_S "57600"
|
#define BAUDRATE_S "115200"
|
||||||
#ifdef linux
|
#ifdef linux
|
||||||
#define MODEMDEVICE "/dev/ttyS0"
|
#define MODEMDEVICE "/dev/ttyS0"
|
||||||
#else
|
#else
|
||||||
|
@ -80,7 +82,8 @@ print_hex_line(unsigned char *prefix, unsigned char *outbuf, int index)
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
int main(int argc, char **argv)
|
int
|
||||||
|
main(int argc, char **argv)
|
||||||
{
|
{
|
||||||
struct termios options;
|
struct termios options;
|
||||||
fd_set mask, smask;
|
fd_set mask, smask;
|
||||||
|
@ -95,21 +98,21 @@ int main(int argc, char **argv)
|
||||||
unsigned char lastc = '\0';
|
unsigned char lastc = '\0';
|
||||||
|
|
||||||
int index = 1;
|
int index = 1;
|
||||||
while (index < argc) {
|
while(index < argc) {
|
||||||
if (argv[index][0] == '-') {
|
if(argv[index][0] == '-') {
|
||||||
switch(argv[index][1]) {
|
switch(argv[index][1]) {
|
||||||
case 'b':
|
case 'b':
|
||||||
/* set speed */
|
/* set speed */
|
||||||
if (strcmp(&argv[index][2], "38400") == 0) {
|
if(strcmp(&argv[index][2], "38400") == 0) {
|
||||||
speed = B38400;
|
speed = B38400;
|
||||||
speedname = "38400";
|
speedname = "38400";
|
||||||
} else if (strcmp(&argv[index][2], "19200") == 0) {
|
} else if(strcmp(&argv[index][2], "19200") == 0) {
|
||||||
speed = B19200;
|
speed = B19200;
|
||||||
speedname = "19200";
|
speedname = "19200";
|
||||||
} else if (strcmp(&argv[index][2], "57600") == 0) {
|
} else if(strcmp(&argv[index][2], "57600") == 0) {
|
||||||
speed = B57600;
|
speed = B57600;
|
||||||
speedname = "57600";
|
speedname = "57600";
|
||||||
} else if (strcmp(&argv[index][2], "115200") == 0) {
|
} else if(strcmp(&argv[index][2], "115200") == 0) {
|
||||||
speed = B115200;
|
speed = B115200;
|
||||||
speedname = "115200";
|
speedname = "115200";
|
||||||
} else {
|
} else {
|
||||||
|
@ -153,7 +156,7 @@ int main(int argc, char **argv)
|
||||||
index++;
|
index++;
|
||||||
} else {
|
} else {
|
||||||
device = argv[index++];
|
device = argv[index++];
|
||||||
if (index < argc) {
|
if(index < argc) {
|
||||||
fprintf(stderr, "too many arguments\n");
|
fprintf(stderr, "too many arguments\n");
|
||||||
return usage(1);
|
return usage(1);
|
||||||
}
|
}
|
||||||
|
@ -161,34 +164,37 @@ int main(int argc, char **argv)
|
||||||
}
|
}
|
||||||
fprintf(stderr, "connecting to %s (%s)", device, speedname);
|
fprintf(stderr, "connecting to %s (%s)", device, speedname);
|
||||||
|
|
||||||
#ifndef __APPLE__
|
#ifdef O_SYNC
|
||||||
fd = open(device, O_RDWR | O_NOCTTY | O_NDELAY | O_DIRECT | O_SYNC );
|
fd = open(device, O_RDWR | O_NOCTTY | O_NDELAY | O_DIRECT | O_SYNC);
|
||||||
|
if(fd < 0 && errno == EINVAL){ // O_SYNC not supported (e.g. raspberian)
|
||||||
|
fd = open(device, O_RDWR | O_NOCTTY | O_NDELAY | O_DIRECT);
|
||||||
|
}
|
||||||
#else
|
#else
|
||||||
fd = open(device, O_RDWR | O_NOCTTY | O_NDELAY | O_SYNC );
|
fd = open(device, O_RDWR | O_NOCTTY | O_NDELAY | O_SYNC );
|
||||||
#endif
|
#endif
|
||||||
if (fd <0) {
|
if(fd < 0) {
|
||||||
fprintf(stderr, "\n");
|
fprintf(stderr, "\n");
|
||||||
perror(device);
|
perror("open");
|
||||||
exit(-1);
|
exit(-1);
|
||||||
}
|
}
|
||||||
fprintf(stderr, " [OK]\n");
|
fprintf(stderr, " [OK]\n");
|
||||||
|
|
||||||
if (fcntl(fd, F_SETFL, 0) < 0) {
|
if(fcntl(fd, F_SETFL, 0) < 0) {
|
||||||
perror("could not set fcntl");
|
perror("could not set fcntl");
|
||||||
exit(-1);
|
exit(-1);
|
||||||
}
|
}
|
||||||
|
|
||||||
if (tcgetattr(fd, &options) < 0) {
|
if(tcgetattr(fd, &options) < 0) {
|
||||||
perror("could not get options");
|
perror("could not get options");
|
||||||
exit(-1);
|
exit(-1);
|
||||||
}
|
}
|
||||||
/* fprintf(stderr, "serial options set\n"); */
|
/* fprintf(stderr, "serial options set\n"); */
|
||||||
cfsetispeed(&options, speed);
|
cfsetispeed(&options, speed);
|
||||||
cfsetospeed(&options, speed);
|
cfsetospeed(&options, speed);
|
||||||
/* Enable the receiver and set local mode */
|
/* Enable the receiver and set local mode */
|
||||||
options.c_cflag |= (CLOCAL | CREAD);
|
options.c_cflag |= (CLOCAL | CREAD);
|
||||||
/* Mask the character size bits and turn off (odd) parity */
|
/* Mask the character size bits and turn off (odd) parity */
|
||||||
options.c_cflag &= ~(CSIZE|PARENB|PARODD);
|
options.c_cflag &= ~(CSIZE | PARENB | PARODD);
|
||||||
/* Select 8 data bits */
|
/* Select 8 data bits */
|
||||||
options.c_cflag |= CS8;
|
options.c_cflag |= CS8;
|
||||||
|
|
||||||
|
@ -197,28 +203,27 @@ int main(int argc, char **argv)
|
||||||
/* Raw output */
|
/* Raw output */
|
||||||
options.c_oflag &= ~OPOST;
|
options.c_oflag &= ~OPOST;
|
||||||
|
|
||||||
if (tcsetattr(fd, TCSANOW, &options) < 0) {
|
if(tcsetattr(fd, TCSANOW, &options) < 0) {
|
||||||
perror("could not set options");
|
perror("could not set options");
|
||||||
exit(-1);
|
exit(-1);
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Make read() return immediately */
|
/* Make read() return immediately */
|
||||||
/* if (fcntl(fd, F_SETFL, FNDELAY) < 0) { */
|
/* if (fcntl(fd, F_SETFL, FNDELAY) < 0) { */
|
||||||
/* perror("\ncould not set fcntl"); */
|
/* perror("\ncould not set fcntl"); */
|
||||||
/* exit(-1); */
|
/* exit(-1); */
|
||||||
/* } */
|
/* } */
|
||||||
|
|
||||||
FD_ZERO(&mask);
|
FD_ZERO(&mask);
|
||||||
FD_SET(fd, &mask);
|
FD_SET(fd, &mask);
|
||||||
FD_SET(fileno(stdin), &mask);
|
FD_SET(fileno(stdin), &mask);
|
||||||
|
|
||||||
index = 0;
|
index = 0;
|
||||||
for (;;) {
|
for(;;) {
|
||||||
smask = mask;
|
smask = mask;
|
||||||
nfound = select(FD_SETSIZE, &smask, (fd_set *) 0, (fd_set *) 0,
|
nfound = select(FD_SETSIZE, &smask, (fd_set *) 0, (fd_set *) 0, (struct timeval *) 0);
|
||||||
(struct timeval *) 0);
|
|
||||||
if(nfound < 0) {
|
if(nfound < 0) {
|
||||||
if (errno == EINTR) {
|
if(errno == EINTR) {
|
||||||
fprintf(stderr, "interrupted system call\n");
|
fprintf(stderr, "interrupted system call\n");
|
||||||
continue;
|
continue;
|
||||||
}
|
}
|
||||||
|
@ -230,21 +235,21 @@ int main(int argc, char **argv)
|
||||||
if(FD_ISSET(fileno(stdin), &smask)) {
|
if(FD_ISSET(fileno(stdin), &smask)) {
|
||||||
/* data from standard in */
|
/* data from standard in */
|
||||||
int n = read(fileno(stdin), buf, sizeof(buf));
|
int n = read(fileno(stdin), buf, sizeof(buf));
|
||||||
if (n < 0) {
|
if(n < 0) {
|
||||||
perror("could not read");
|
perror("could not read");
|
||||||
exit(-1);
|
exit(-1);
|
||||||
} else if (n > 0) {
|
} else if(n > 0) {
|
||||||
/* because commands might need parameters, lines needs to be
|
/* because commands might need parameters, lines needs to be
|
||||||
separated which means the terminating LF must be sent */
|
separated which means the terminating LF must be sent */
|
||||||
/* while(n > 0 && buf[n - 1] < 32) { */
|
/* while(n > 0 && buf[n - 1] < 32) { */
|
||||||
/* n--; */
|
/* n--; */
|
||||||
/* } */
|
/* } */
|
||||||
if(n > 0) {
|
if(n > 0) {
|
||||||
int i;
|
int i;
|
||||||
/* fprintf(stderr, "SEND %d bytes\n", n);*/
|
/* fprintf(stderr, "SEND %d bytes\n", n);*/
|
||||||
/* write slowly */
|
/* write slowly */
|
||||||
for (i = 0; i < n; i++) {
|
for(i = 0; i < n; i++) {
|
||||||
if (write(fd, &buf[i], 1) <= 0) {
|
if(write(fd, &buf[i], 1) <= 0) {
|
||||||
perror("write");
|
perror("write");
|
||||||
exit(1);
|
exit(1);
|
||||||
} else {
|
} else {
|
||||||
|
@ -261,7 +266,7 @@ int main(int argc, char **argv)
|
||||||
|
|
||||||
if(FD_ISSET(fd, &smask)) {
|
if(FD_ISSET(fd, &smask)) {
|
||||||
int i, j, n = read(fd, buf, sizeof(buf));
|
int i, j, n = read(fd, buf, sizeof(buf));
|
||||||
if (n < 0) {
|
if(n < 0) {
|
||||||
perror("could not read");
|
perror("could not read");
|
||||||
exit(-1);
|
exit(-1);
|
||||||
}
|
}
|
||||||
|
@ -320,8 +325,7 @@ int main(int argc, char **argv)
|
||||||
if(index > 0) {
|
if(index > 0) {
|
||||||
if(flags != 2 && mode != MODE_SLIP_HIDE) {
|
if(flags != 2 && mode != MODE_SLIP_HIDE) {
|
||||||
/* not overflowed: show packet */
|
/* not overflowed: show packet */
|
||||||
print_hex_line("SLIP: ", rxbuf,
|
print_hex_line("SLIP: ", rxbuf, index > HCOLS ? HCOLS : index);
|
||||||
index > HCOLS ? HCOLS : index);
|
|
||||||
printf("\n");
|
printf("\n");
|
||||||
}
|
}
|
||||||
lastc = '\0';
|
lastc = '\0';
|
||||||
|
|
Loading…
Reference in a new issue