Set speed on all joints to 0 before closing RT socket. Set short timeout on non-RT socket

src/ur_communication.cpp

@@ -104,6 +104,8 @@ void UrCommunication::run() {
 		command_string_lock_.unlock();
 
 	}
+	//wait for some traffic so the UR socket doesn't die in version 3.1.
+	std::this_thread::sleep_for(std::chrono::milliseconds(500));
 	close(sockfd_);
 }
 

src/ur_realtime_communication.cpp

@@ -99,6 +99,8 @@ void UrRealtimeCommunication::run() {
 		command_string_lock_.unlock();
 
 	}
+	setSpeed(0., 0., 0., 0., 0., 0.);
+	write(sockfd_, command_.c_str(), command_.length());
 	close(sockfd_);
 }