diff --git a/src/C++/Driver/src/main.cpp b/src/C++/Driver/src/main.cpp index 1e48f84..0781422 100644 --- a/src/C++/Driver/src/main.cpp +++ b/src/C++/Driver/src/main.cpp @@ -44,12 +44,19 @@ std::string readMQTT() void parseMQTT(std::string message){ if(message == "up"){ robot.forward(600); + message = 0; } else if(message == "left"){ robot.Rotate(90); + message = 0; + } else if(message == "down"){ robot.Rotate(-90); + message = 0; + } + else if(message = 0){ + robot.sendNullMessage(); } else{ std::cout << "Invalid command" << std::endl;