made more debug

This commit is contained in:
ishak jmilou.ishak
2025-01-20 10:58:34 +01:00
parent c31689ac70
commit aedff1c2cc

View File

@@ -59,25 +59,36 @@ std::mutex connectionMutex;
void checkKobukiConnection() void checkKobukiConnection()
{ {
while (true) while (true)
{
{ {
std::lock_guard<std::mutex> lock(connectionMutex); std::lock_guard<std::mutex> lock(connectionMutex);
bool connected = robot.isConnected(); if (!robot.isConnected())
if (!connected && kobuki_connected) {
if (kobuki_connected)
{ {
cout << "Kobuki is disconnected" << endl; cout << "Kobuki is disconnected" << endl;
kobuki_connected = false; kobuki_connected = false;
} }
else if (connected && !kobuki_connected) // Probeer opnieuw te verbinden
{ cout << "Attempting to reconnect Kobuki..." << endl;
cout << "Kobuki is reconnecting..." << endl;
robot.startCommunication("/dev/ttyUSB0", true, nullptr); robot.startCommunication("/dev/ttyUSB0", true, nullptr);
kobuki_connected = true; kobuki_connected = robot.isConnected();
if (kobuki_connected)
{
cout << "Kobuki reconnected successfully!" << endl;
}
else
{
cout << "Failed to reconnect Kobuki, retrying in 5 seconds..." << endl;
}
}
} }
std::this_thread::sleep_for(std::chrono::seconds(5)); // Controleer elke 5 seconden std::this_thread::sleep_for(std::chrono::seconds(5)); // Controleer elke 5 seconden
} }
} }
std::string readMQTT() std::string readMQTT()
{ {
static std::string lastMessage; static std::string lastMessage;