Changeset 196 in flair-src for trunk/lib/FlairSensorActuator/src/NeoM8N.cpp
- Timestamp:
- Sep 12, 2017, 11:26:33 AM (8 years ago)
- File:
-
- 1 edited
Legend:
- Unmodified
- Added
- Removed
-
trunk/lib/FlairSensorActuator/src/NeoM8N.cpp
r195 r196 42 42 43 43 void NeoM8N::Run(void) { 44 char response[200] = {0}; 45 int size,written; 46 47 //turn off all mesages 44 45 //turn off all messages 48 46 { 49 47 char tx[]={0x06, 0x01, 0x03, 0, 0xf0, 0,0}; … … 82 80 83 81 while (!ToBeStopped()) { 84 //SleepMS(10);??85 size = 0;82 char response[1024] = {0}; 83 int size = 0; 86 84 while (!ToBeStopped()) { 87 85 ssize_t read = serialport->Read(&response[size], 1); … … 90 88 } 91 89 92 if (response[size] == 0x0a) 93 break; 90 if (response[size] == 0x0a ) break; 94 91 size++; 92 if (size==sizeof(response)) break; 95 93 } 96 size++; 97 parseFrame(response, size); 94 if (size!=sizeof(response)) { 95 size++; 96 parseFrame(response, size); 97 } else { 98 Thread::Warn("frame too long for buffer\n"); 99 } 98 100 } 99 101 /** fin running loop **/
Note:
See TracChangeset
for help on using the changeset viewer.