-
Notifications
You must be signed in to change notification settings - Fork 0
/
UARTHandler.cpp
59 lines (53 loc) · 1.28 KB
/
UARTHandler.cpp
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
#include "UARTHandler.h"
UARTHandler::UARTHandler() {
Serial.begin(9600);
this->listeners = NULL;
this->defaultListener = NULL;
this->idx = 0;
}
UARTHandler::~UARTHandler() {
while(this->listeners != NULL) {
UARTListener* p = this->listeners;
this->listeners = this->listeners->prev;
delete p;
}
Serial.end();
}
void UARTHandler::addDefaultListener( void(*listener)(char, char*)) {
this->defaultListener = listener;
}
void UARTHandler::loop() {
if (Serial.available() > 0) {
char d = Serial.read();
if(d != 10) {
this->data[this->idx++] = d;
} else {
char pcode = this->data[0];
char pdata[this->idx];
memcpy(pdata, this->data+1, this->idx);
pdata[this->idx-1]=0;
this->idx = 0;
this->fireEvent(pcode, pdata);
}
}
}
void UARTHandler::addListener(char code, void(*listener)(char*)) {
UARTListener* p = new UARTListener();
p->prev = this->listeners;
p->listener = listener;
p->code = code;
this->listeners = p;
}
void UARTHandler::fireEvent(char pcode, char* pdata) {
UARTListener* p = this->listeners;
while(p != NULL) {
if(p->code == pcode){
p->listener(pdata);
return;
}
p = this->listeners->prev;
}
if(this->defaultListener != NULL) {
this->defaultListener(pcode, pdata);
}
}