diff --git a/src/C++/Driver/src/main.cpp b/src/C++/Driver/src/main.cpp
index 22d8669..fdf3f94 100644
--- a/src/C++/Driver/src/main.cpp
+++ b/src/C++/Driver/src/main.cpp
@@ -15,8 +15,6 @@ CKobuki robot;
 std::string readMQTT();
 void parseMQTT(std::string message);
 void CapnSend();
-void reconnectKobuki();
-void monitorKobukiConnection();
 // ip, clientID, username, password
 MqttClient client("ws://145.92.224.21/ws/", "KobukiRPI", "rpi",
                   "rpiwachtwoordofzo"); // create a client object
@@ -32,13 +30,10 @@ void setup() {
   client.connect();
   client.subscribe("home/commands");
 
-  std::thread monitorThread(monitorKobukiConnection);
-  monitorThread.detach();
 }
 
 int main() {
   setup();
-  reconnectKobuki();
 
   std::thread image(CapnSend);
   std::thread safety([&]() { robot.robotSafety(&message); });
@@ -56,31 +51,6 @@ 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 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() {
   static std::string lastMessage;