mirror of
https://github.com/westonrobot/ugv_sdk
synced 2023-04-08 06:32:14 +08:00
saved work on timeout
This commit is contained in:
@@ -98,7 +98,7 @@ int main(int argc, char **argv) {
|
||||
// scout.SetLightCommand({ScoutLightCmd::LightMode::BREATH, 0,
|
||||
// ScoutLightCmd::LightMode::BREATH, 0});
|
||||
// }
|
||||
if (count < 250) {
|
||||
if (count < 100) {
|
||||
std::cout << "Motor: 0.2, 0" << std::endl;
|
||||
scout.SetMotionCommand(0.2, 0.0);
|
||||
}
|
||||
|
||||
@@ -74,7 +74,7 @@ void MobileBase::ControlLoop(int32_t period_ms) {
|
||||
timeout_iter_num = static_cast<uint32_t>(timeout_ms_ / period_ms);
|
||||
std::cout << "Timeout iteration number: " << timeout_iter_num << std::endl;
|
||||
}
|
||||
|
||||
|
||||
while (true) {
|
||||
ctrl_sw.tic();
|
||||
if (enable_timeout_) {
|
||||
@@ -82,7 +82,7 @@ void MobileBase::ControlLoop(int32_t period_ms) {
|
||||
SendRobotCmd();
|
||||
++watchdog_counter_;
|
||||
} else {
|
||||
std::cout << "Warning: cmd timeout, not sent to robot" << std::endl;
|
||||
std::cout << "Warning: cmd timeout, old cmd not sent to robot" << std::endl;
|
||||
}
|
||||
} else {
|
||||
SendRobotCmd();
|
||||
|
||||
Reference in New Issue
Block a user