-
Notifications
You must be signed in to change notification settings - Fork 0
/
RemoteCommand.cpp
69 lines (57 loc) · 1.4 KB
/
RemoteCommand.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
60
61
62
63
64
65
66
67
68
69
#include "RemoteCommand.h"
void RemoteCommand::init() {
_inputString = "";
_stringComplete = false;
}
// Called from serialEvent()
void RemoteCommand::readCommand() {
while (Serial.available() && !_stringComplete) {
char inChar = (char)Serial.read();
if (inChar == '\n') {
_stringComplete = true;
//Serial.print("CONSOLE:");
//Serial.println(_inputString);
} else {
_inputString += inChar;
}
}
}
// Called from loop()
boolean RemoteCommand::received() {
return _stringComplete;
}
ParsedCommand RemoteCommand::_parse() {
ParsedCommand data;
if (!_stringComplete) {
return data;
}
int dataLength = _inputString.length();
int firstSep = _inputString.indexOf(COMMAND_SEPARATOR);
if(firstSep == -1) {
data.cmd = _inputString;
return data;
}
if(firstSep + 1 >= dataLength) return data;
data.cmd = _inputString.substring(0,firstSep);
// get args
unsigned int index = 0;
while(firstSep + 1 < dataLength && index < MAX_ARGS) {
int secondSep = _inputString.indexOf(COMMAND_SEPARATOR, firstSep+1);
// pour le dernier argument
if(secondSep == -1) {
secondSep = dataLength;
}
String arg = _inputString.substring(firstSep+1, secondSep);
firstSep = secondSep;
data.arrayArgs[index] = arg;
index++;
}
return data;
}
// Called from loop()
ParsedCommand RemoteCommand::get() {
ParsedCommand data = _parse();
_inputString = "";
_stringComplete = false;
return data;
}