diff --git a/src/C++/Driver/src/main.cpp b/src/C++/Driver/src/main.cpp index 16416b5..1531fe3 100644 --- a/src/C++/Driver/src/main.cpp +++ b/src/C++/Driver/src/main.cpp @@ -32,15 +32,15 @@ void setup() { client.connect(); client.subscribe("home/commands"); - std::thread monitorThread(monitorKobukiConnection); - monitorThread.detach(); +// std::thread monitorThread(monitorKobukiConnection); +// monitorThread.detach(); } int main() { setup(); - reconnectKobuki(); +// reconnectKobuki(); - std::thread connectionMonitor(monitorKobukiConnection); +// std::thread connectionMonitor(monitorKobukiConnection); std::thread image(CapnSend); std::thread safety([&]() { robot.robotSafety(&message); }); std::thread sendMqtt([&]() { sendKobukiData(robot.parser.data); }); @@ -57,29 +57,29 @@ int main() { image.join(); } -void reconnectKobuki() { - unsigned char *null_ptr(0); - while (true) { - if (robot.startCommunication("/dev/ttyUSB0", true, null_ptr) != -1) { - std::cout << "Kobuki opnieuw verbonden!" << std::endl; - break; // Verlaat de loop als de verbinding succesvol is - } else { - std::cerr << "Kobuki niet verbonden. Probeer opnieuw over 3 seconden..." << std::endl; - std::this_thread::sleep_for(std::chrono::seconds(3)); - } - } -} +// void reconnectKobuki() { +// unsigned char *null_ptr(0); +// while (true) { +// if (robot.startCommunication("/dev/ttyUSB0", true, null_ptr) != -1) { +// std::cout << "Kobuki opnieuw verbonden!" << std::endl; +// break; // Verlaat de loop als de verbinding succesvol is +// } else { +// std::cerr << "Kobuki niet verbonden. Probeer opnieuw over 3 seconden..." << std::endl; +// std::this_thread::sleep_for(std::chrono::seconds(3)); +// } +// } +// } -void monitorKobukiConnection() { - while (true) { - // Check regelmatig of de verbinding actief is - if (!robot.isConnected()) { - std::cerr << "Kobuki verbinding verloren. Reconnectie starten..." << std::endl; - reconnectKobuki(); - } - std::this_thread::sleep_for(std::chrono::seconds(5)); // Check iedere 5 seconden - } -} +// void monitorKobukiConnection() { +// while (true) { +// // Check regelmatig of de verbinding actief is +// if (!robot.isConnected()) { +// std::cerr << "Kobuki verbinding verloren. Reconnectie starten..." << std::endl; +// reconnectKobuki(); +// } +// std::this_thread::sleep_for(std::chrono::seconds(5)); // Check iedere 5 seconden +// } +// } std::string readMQTT() {