FreeCalypso > hg > freecalypso-tools

comparison rvinterf/lowlevel/packetrx.c @ 0:e7502631a0f9

Find changesets by keywords (author, files, the commit message), revision number or hash, or revset expression.
initial import from freecalypso-sw rev 1033:5ab737ac3ad7
author Mychaela Falconia <falcon@freecalypso.org>
date Sat, 11 Jun 2016 00:13:35 +0000
parents
children
comparison
equal deleted inserted replaced
-1:000000000000 0:e7502631a0f9
1 /*
2 * This module handles the lowest level of serial packet Rx
3 */
4
5 #include <sys/types.h>
6 #include <stdio.h>
7 #include <stdlib.h>
8 #include <unistd.h>
9 #include "../include/pktmux.h"
10 #include "../include/limits.h"
11
12 extern int target_fd;
13
14 u_char rxpkt[MAX_PKT_FROM_TARGET];
15 size_t rxpkt_len;
16
17 static int in_pkt, dle_state, toobig;
18
19 static void
20 process_inbyte(inb)
21 {
22 char errbuf[128];
23
24 if (!in_pkt) {
25 if (inb != STX || dle_state) {
26 rxpkt_len++;
27 dle_state = (inb == DLE);
28 return;
29 }
30 if (rxpkt_len) {
31 sprintf(errbuf,
32 "Warning: Rx %u byte%s outside of a packet",
33 (unsigned)rxpkt_len, rxpkt_len != 1 ? "s" : "");
34 output_line(errbuf);
35 rxpkt_len = 0;
36 }
37 in_pkt = 1;
38 toobig = 0;
39 return;
40 }
41 if (dle_state) {
42 dle_state = 0;
43 if (inb != STX && inb != DLE) {
44 sprintf(errbuf,
45 "Rx framing error: %02X after DLE", inb);
46 output_line(errbuf);
47 in_pkt = 0;
48 rxpkt_len = 0;
49 return;
50 }
51 goto data;
52 }
53 if (inb == DLE) {
54 dle_state = 1;
55 return;
56 } else if (inb == STX) {
57 if (!rxpkt_len)
58 return;
59 in_pkt = 0;
60 handle_rx_packet();
61 rxpkt_len = 0;
62 return;
63 }
64 data: if (rxpkt_len >= MAX_PKT_FROM_TARGET) {
65 if (!toobig) {
66 output_line("Error: Rx packet too big!");
67 toobig = 1;
68 }
69 return;
70 }
71 rxpkt[rxpkt_len++] = inb;
72 }
73
74 void
75 process_serial_rx()
76 {
77 u_char rdbuf[512];
78 int cc, i;
79
80 cc = read(target_fd, rdbuf, sizeof rdbuf);
81 if (cc <= 0) {
82 perror("Error/EOF reading from target");
83 exit(1);
84 }
85 for (i = 0; i < cc; i++)
86 process_inbyte(rdbuf[i]);
87 }