diff --git a/TCPServer.cpp b/TCPServer.cpp
index d7708ec..652ac5a 100644
--- a/TCPServer.cpp
+++ b/TCPServer.cpp
@@ -175,6 +175,7 @@ void TCPServer::handleMessage(const std::string& message, int clientSocket)
             if (lidarGetPosTimeout > 10) {
                 awaitForLidar = false;
             }
+            lidarGetPosTimeout++;
             this->askLidarPosition();
         }
         else {