1 changed files with 2 additions and 2 deletions
+ 2
- 2
lfr_state_machine.cpp
View File
| double wheels[4] = {0.0, 0.0, 0.0, 0.0}; | double wheels[4] = {0.0, 0.0, 0.0, 0.0}; | ||||
| int mode = std::stoi(splitStr[0]); | int mode = std::stoi(splitStr[0]); | ||||
| if(mode == 0) { | if(mode == 0) { | ||||
| for(int i = 1; i < 4; i++) | |||||
| for(int i = 1; i <= 4; i++) | |||||
| { | { | ||||
| wheels[i] = std::stod(splitStr[i]); | |||||
| wheels[i-1] = std::stod(splitStr[i]); | |||||
| } | } | ||||
| setState(State::Manual::getInstance()); | setState(State::Manual::getInstance()); | ||||
| uartCommunicator.sendTelegram(wheels[0], wheels[1], wheels[2], wheels[3]); | uartCommunicator.sendTelegram(wheels[0], wheels[1], wheels[2], wheels[3]); |
Loading…