URL
https://opencores.org/ocsvn/logicprobe/logicprobe/trunk
Subversion Repositories logicprobe
[/] [logicprobe/] [tags/] [LogicProbe-1.1/] [src/] [pc/] [receive.c] - Rev 10
Go to most recent revision | Compare with Previous | Blame | View Log
/* * receive.c -- LogicProbe serial line receiver */ #include <stdio.h> #include <stdlib.h> #include <string.h> #include <stdarg.h> #include <fcntl.h> #include <unistd.h> #include <termios.h> #define SERIAL_PORT "/dev/ttyS0" static int debug = 0; static FILE *diskFile = NULL; static int sfd = 0; static struct termios origOptions; static struct termios currOptions; void serialClose(void); void error(char *fmt, ...) { va_list ap; va_start(ap, fmt); printf("Error: "); vprintf(fmt, ap); printf("\n"); va_end(ap); if (diskFile != NULL) { fclose(diskFile); diskFile = NULL; } if (sfd != 0) { serialClose(); sfd = 0; } exit(1); } void serialOpen(void) { sfd = open(SERIAL_PORT, O_RDWR | O_NOCTTY | O_NDELAY); if (sfd == -1) { error("cannot open serial port '%s'", SERIAL_PORT); } tcgetattr(sfd, &origOptions); currOptions = origOptions; cfsetispeed(&currOptions, B38400); cfsetospeed(&currOptions, B38400); currOptions.c_cflag |= (CLOCAL | CREAD); currOptions.c_cflag &= ~PARENB; currOptions.c_cflag &= ~CSTOPB; currOptions.c_cflag &= ~CSIZE; currOptions.c_cflag |= CS8; currOptions.c_cflag &= ~CRTSCTS; currOptions.c_lflag &= ~(ICANON | ECHO | ECHONL | ISIG | IEXTEN); currOptions.c_iflag &= ~(IGNBRK | BRKINT | IGNPAR | PARMRK); currOptions.c_iflag &= ~(INPCK | ISTRIP | INLCR | IGNCR | ICRNL); currOptions.c_iflag &= ~(IXON | IXOFF | IXANY); currOptions.c_oflag &= ~(OPOST | ONLCR | OCRNL | ONOCR | ONLRET); tcsetattr(sfd, TCSANOW, &currOptions); } void serialClose(void) { tcsetattr(sfd, TCSANOW, &origOptions); close(sfd); } int serialSnd(unsigned char b) { int n; n = write(sfd, &b, 1); return n == 1; } int serialRcv(unsigned char *bp) { int n; n = read(sfd, bp, 1); return n == 1; } int main(int argc, char *argv[]) { unsigned char b; int i, j; if (argc != 2) { printf("Usage: %s <data_file>\n", argv[0]); exit(1); } diskFile = fopen(argv[1], "wb"); if (diskFile == NULL) { error("cannot open data file %s for write", argv[1]); } serialOpen(); serialRcv(&b); for (i = 0; i < 512; i++) { if (debug) { printf("%03d: ", i); } for (j = 0; j < 16; j++) { while (!serialRcv(&b)) ; if (fwrite(&b, 1, 1, diskFile) != 1) { error("cannot write to data file %s", argv[1]); } if (debug) { printf("%02X ", b); } } if (debug) { printf("\n"); } } if (diskFile != NULL) { fclose(diskFile); diskFile = NULL; } if (sfd != 0) { serialClose(); sfd = 0; } return 0; }
Go to most recent revision | Compare with Previous | Blame | View Log