forked from malaise/c
-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathserial_spy.c
88 lines (71 loc) · 1.53 KB
/
serial_spy.c
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
#include <stdio.h>
#include <stdlib.h>
#include "tty.h"
#define BUFFER_SIZE 1000
extern int fd;
static unsigned char buffer[BUFFER_SIZE];
static unsigned int index;
static void store (unsigned char oct) {
if (index == BUFFER_SIZE - 1) {
index = 0;
}
buffer[index] = oct;
index ++;
}
static void print (char oct) {
if (oct < 32) printf ("'%02X' ", (int)oct);
else printf ("%c ", oct);
}
static void flush (void) {
unsigned int i;
for (i = 0; i < index; i++) {
print (buffer[i]);
}
printf ("\n");
fflush(stdout);
index = 0;
}
int main(int argc, char *argv[]) {
unsigned char oct;
#if defined(DACOTA)
unsigned char prev_oct, prev_prev_oct;
#endif
int started;
if ( argc != 2) {
printf ("SYNTAX ERROR. Usage : serial_spy <tty_no>:<stopb>:<datab>:<parity>:<bauds>\n");
exit (1);
}
init_tty(argv[1], 1);
started = 0;
#if defined(DACOTA)
prev_oct = '0';
prev_prev_oct = '0';
#endif
index = 0;
for(;;) {
read_tty (&oct, 1);
#if defined(STANDARD) || defined(TAAATS)
if (oct == 0x02) started = 1;
if (started) {
store (oct);
if (oct == 0x0d) flush();
}
#elif defined(PALLAS)
if (oct == 'T') started = 1;
if (started) {
store (oct);
if (oct == 0x0a) flush ();
}
#elif defined(DACOTA)
if (oct == 0x01) started = 1;
if (started) {
if ( (oct == 0x01) && (prev_prev_oct == 0x04) ) flush ();
store (oct);
}
prev_prev_oct = prev_oct;
prev_oct = oct;
#else
define STANDARD or TAAATS or PALLAS or DACOTA
#endif
}
}