25 |
|
|
26 |
while (mContinue) |
while (mContinue) |
27 |
{ |
{ |
28 |
|
msleep(80); |
29 |
store->led3 = serial.readTarget(0); |
store->led3 = serial.readTarget(0); |
30 |
msleep(delay); |
msleep(delay); |
31 |
|
|
53 |
{ |
{ |
54 |
WriteCommand cmd = store->commands.front(); |
WriteCommand cmd = store->commands.front(); |
55 |
store->commands.pop(); |
store->commands.pop(); |
56 |
|
std::cout << "Command:"<< (int) cmd.target<<","<< (int) cmd.data << std::endl; |
57 |
serial.writeTarget( cmd.target, cmd.data); |
serial.writeTarget( cmd.target, cmd.data); |
58 |
} |
} |
59 |
|
|
|
|
|
|
msleep(80); |
|
60 |
} |
} |
61 |
mStopped = true; |
mStopped = true; |
62 |
} |
} |