diff --git a/src/C++/Driver/src/main.cpp b/src/C++/Driver/src/main.cpp index 901acfe..d626ebe 100644 --- a/src/C++/Driver/src/main.cpp +++ b/src/C++/Driver/src/main.cpp @@ -19,15 +19,15 @@ void setup(){ robot.startCommunication("/dev/ttyUSB0", true, null_ptr); client.connect(); client.subscribe("home/commands"); - parseMQTT(readMQTT()); } int main(){ setup(); + client.run(); while(true){ - readMQTT(); + parseMQTT(readMQTT()); + cout << readMQTT() << endl; //debugging } - client.run(); return 0; } @@ -37,7 +37,9 @@ std::string readMQTT() if (!message.empty()) { std::cout << "MQTT Message: " << message << std::endl; } - + else { + std::cout << "No message received" << std::endl; + } // Add a small delay to avoid busy-waiting std::this_thread::sleep_for(std::chrono::milliseconds(100)); return message;