1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
|
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <termios.h>
#include <stdio.h>
/* baudrate settings are defined in <asm/termbits.h>, which is
included by <termios.h> */
#define BAUDRATE B9600
/* change this definition for the correct port */
#define PCRDEV "/dev/ttyS0"
#define _POSIX_SOURCE 1 /* POSIX compliant source */
#define FALSE 0
#define TRUE 1
volatile int STOP=FALSE;
main(int argc, char *argv[])
{
int fd,a,b,c, res;
struct termios oldtio,newtio;
char buf[256];
char buf2[256];
char buf3[256];
/* Open modem device for reading and writing and not as controlling tty
because we don't want to get killed if linenoise sends CTRL-C. */
fd = open(PCRDEV, O_RDWR | O_NOCTTY );
if (fd <0) {perror(PCRDEV); exit(-1); }
tcgetattr(fd,&oldtio); /* save current serial port settings */
bzero(&newtio, sizeof(newtio));
/*
BAUDRATE: Set bps rate. use cfsetispeed and cfsetospeed.
CS8 : 8n1 (8bit,no parity,1 stopbit)
CLOCAL : local connection, no modem contol
CREAD : enable receiving characters
*/
cfsetispeed( &newtio, BAUDRATE );
cfsetospeed( &newtio, BAUDRATE );
newtio.c_cflag |= (CLOCAL | CREAD);
newtio.c_cflag &= ~HUPCL ;
newtio.c_cflag &= ~PARENB ;
newtio.c_cflag &= ~CSTOPB ;
newtio.c_cflag &= ~CSIZE;
newtio.c_cflag |= CS8;
/* ICANON : enable canonical input disable all echo functionality,
and don't send signals to calling program */
newtio.c_lflag |= ICANON;
newtio.c_lflag &= ~(ECHO | ECHOCTL);
/* Raw output. */
newtio.c_oflag &= ~OPOST;
/*
IGNPAR : ignore bytes with parity errors
ICRNL : map CR to NL (otherwise a CR input on the other computer
will not terminate input)
otherwise make device raw (no other input processing)
newtio.c_iflag = IGNPAR ;
*/
/* initialize control characters */
/* newtio.c_cc[VTIME] = 5; *//* inter-character timer unused */
/* newtio.c_cc[VMIN] = 0; *//* blocking read until 1 character arrives */
/* now clean the modem line and activate the settings for the port */
/* tcflush(fd, TCIFLUSH); */
tcsetattr(fd,TCSANOW,&newtio);
if (argc > 1) {
a = 0;
b = 0;
c = 0;
strcpy(buf, "G300\x0d\x0a");
write( fd, buf, strlen(buf));
strcpy(buf, "G4\?\x0d\x0a");
fprintf(stderr, "REQ: %s\n", buf);
write( fd, buf, strlen(buf));
fprintf(stderr, "SNT: %s\n", buf);
a = read(fd, buf, 0xff);
b = read(fd, buf2, 0xff);
c = read(fd, buf3, 0xff);
buf[a]=0;buf2[b]=0;buf3[c]=0;
if (c < 0) {perror("read"); exit(-1);}
fprintf(stderr, "RED: %i,%s %i,%s %i,%s\n", a,buf,b,buf2,c,buf3);
}
/* restore the old port settings */
tcsetattr(fd,TCSANOW,&oldtio);
}
|
