diff --git a/irc_ros_hardware/src/CRI/cri_socket.cpp b/irc_ros_hardware/src/CRI/cri_socket.cpp index 31d4d43..dc84040 100644 --- a/irc_ros_hardware/src/CRI/cri_socket.cpp +++ b/irc_ros_hardware/src/CRI/cri_socket.cpp @@ -148,10 +148,13 @@ void CriSocket::ReceiveThreadFunction() char buffer[bufferSize] = {0}; while (continueReceive) { + + if (connectionNeeded) { MakeConnection(); } + std::fill_n(buffer, bufferSize, '\0'); int valread = read(sock, buffer, bufferSize); if (!IsSocketOk()) {