fix thread going out of scope

src/C++/Driver/src/main.cpp

@@ -19,16 +19,17 @@ void setup(){
 	robot.startCommunication("/dev/ttyUSB0", true, null_ptr);
     client.connect();
     client.subscribe("home/commands");
-    std::thread safety([&]() { robot.robotSafety(&message); });
 
 
 }
 
 int main(){
 	setup();
+    std::thread safety([&]() { robot.robotSafety(&message); });
 	while(true){
     parseMQTT(readMQTT());
 	}
+    safety.join();
 	return 0;
 }