diff --git a/src/C++/Driver/src/main.cpp b/src/C++/Driver/src/main.cpp index d626ebe..9e019b3 100644 --- a/src/C++/Driver/src/main.cpp +++ b/src/C++/Driver/src/main.cpp @@ -48,15 +48,19 @@ std::string readMQTT() void parseMQTT(std::string message){ if(message == "up"){ robot.forward(600); + break; } else if(message == "left"){ robot.Rotate(90); + break; } else if(message == "down"){ robot.Rotate(-90); + break; } else{ std::cout << "Invalid command" << std::endl; + break; } }