diff --git a/src/modelec_com/src/pcb_odo_interface.cpp b/src/modelec_com/src/pcb_odo_interface.cpp index 0284368..c10193b 100644 --- a/src/modelec_com/src/pcb_odo_interface.cpp +++ b/src/modelec_com/src/pcb_odo_interface.cpp @@ -241,6 +241,7 @@ namespace Modelec { if (tokens[1] == "START") { + start_odo_ = tokens[2] == "1"; } else if (tokens[1] == "WAYPOINT") { @@ -364,7 +365,6 @@ namespace Modelec if (!start_odo_) { SendOrder("START", {std::to_string(true)}); - start_odo_ = true; } std::vector data; @@ -393,7 +393,6 @@ namespace Modelec if (!start_odo_) { SendOrder("START", {std::to_string(true)}); - start_odo_ = true; } std::vector data = {