FreeCalypso > hg > fc-sim-tools
comparison serial/xmit.c @ 41:5ee00413b8af
serial: beginning of fcsim-serial-be
| author | Mychaela Falconia <falcon@freecalypso.org> |
|---|---|
| date | Sat, 20 Mar 2021 20:53:51 +0000 |
| parents | |
| children |
comparison
equal
deleted
inserted
replaced
| 40:8f505d413815 | 41:5ee00413b8af |
|---|---|
| 1 /* | |
| 2 * This module implements the function for sending byte strings | |
| 3 * to the SIM and collecting the UART echo. | |
| 4 */ | |
| 5 | |
| 6 #include <sys/types.h> | |
| 7 #include <sys/time.h> | |
| 8 #include <sys/errno.h> | |
| 9 #include <stdio.h> | |
| 10 #include <stdlib.h> | |
| 11 #include <string.h> | |
| 12 #include <strings.h> | |
| 13 #include <unistd.h> | |
| 14 | |
| 15 extern int target_fd; | |
| 16 extern int inverse_coding; | |
| 17 | |
| 18 send_bytes_to_sim(data, nbytes) | |
| 19 u_char *data; | |
| 20 unsigned nbytes; | |
| 21 { | |
| 22 u_char buf1[255], buf2[255]; | |
| 23 fd_set fds; | |
| 24 struct timeval tv; | |
| 25 unsigned rcvd; | |
| 26 int cc; | |
| 27 | |
| 28 bcopy(data, buf1, nbytes); | |
| 29 if (inverse_coding) | |
| 30 invert_bytes(buf1, nbytes); | |
| 31 write(target_fd, buf1, nbytes); | |
| 32 for (rcvd = 0; rcvd < nbytes; ) { | |
| 33 FD_ZERO(&fds); | |
| 34 FD_SET(target_fd, &fds); | |
| 35 tv.tv_sec = 1; | |
| 36 tv.tv_usec = 0; | |
| 37 cc = select(target_fd+1, &fds, NULL, NULL, &tv); | |
| 38 if (cc < 0) { | |
| 39 if (errno == EINTR) | |
| 40 continue; | |
| 41 perror("select"); | |
| 42 return(-1); | |
| 43 } | |
| 44 if (cc < 1) { | |
| 45 fprintf(stderr, | |
| 46 "error: timeout waiting for echo of Tx bytes\n"); | |
| 47 return(-1); | |
| 48 } | |
| 49 cc = read(target_fd, buf2 + rcvd, nbytes - rcvd); | |
| 50 if (cc <= 0) { | |
| 51 perror("read after successful select"); | |
| 52 return(-1); | |
| 53 } | |
| 54 rcvd += cc; | |
| 55 } | |
| 56 if (bcmp(buf1, buf2, nbytes)) { | |
| 57 fprintf(stderr, "error: UART echo mismatch\n"); | |
| 58 return(-1); | |
| 59 } else | |
| 60 return(0); | |
| 61 } |
