diff --git a/src/C++/Driver/src/main.cpp b/src/C++/Driver/src/main.cpp index 16416b5..6444df8 100644 --- a/src/C++/Driver/src/main.cpp +++ b/src/C++/Driver/src/main.cpp @@ -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() {