-
Notifications
You must be signed in to change notification settings - Fork 0
/
bus.ino
65 lines (57 loc) · 1.08 KB
/
bus.ino
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
bool busBusy_interrupt(void)
{
if (digitalRead(BUSBUSY) != 1)
{
return true;
}
return false;
}
void setBusBusy(void)
{
pinMode(BUSBUSY, OUTPUT);
digitalWrite(BUSBUSY, LOW);
}
void clrBusBusy(void)
{
digitalWrite(BUSBUSY, HIGH);
pinMode(BUSBUSY, INPUT);
}
int ProcessBUSmsg(void)
{
if ((bus_msg[1] == 'T') && (bus_msg[2] == 'C') && (bus_msg[3] == 'H') && (bus_msg[4] == 'K') && (bus_msg[5] == 'D'))
{
parseRadioHK();
// CheckGPSFix();
return 0;
}
if ((bus_msg[1] == 'C') && (bus_msg[2] == 'M') && (bus_msg[3] == 'D') && (bus_msg[4] == 'T') && (bus_msg[5] == 'A'))
{
return processCMDTAmsg();
}
return 1;
}
int GetBusMSG(void)
{
char inByte;
int error=10;
// _Serial.listen();
while (_Serial.available() > 0)
{
inByte = _Serial.read();
if ((inByte =='$') || (MSGindex >= 30))
{
MSGindex = 0;
}
if (inByte != '\r')
{
bus_msg[MSGindex++] = inByte;
}
if (inByte == '\n')
{
// _Serial.println("endline");
error=ProcessBUSmsg();
MSGindex = 0;
}
}
return error;
}