diff --git a/TCPServer.cpp b/TCPServer.cpp
index 631797f..e723ef2 100644
--- a/TCPServer.cpp
+++ b/TCPServer.cpp
@@ -237,6 +237,7 @@ void TCPServer::handleMessage(const std::string& message, int clientSocket)
             this->endRobotPose = {finishPoint[0], finishPoint[1], finishPoint[2]};
 
             for (int j = 0; j < 3; j++) {
+                std::cout << "AHHHHHHHHHHHHHHHHHH  " << this->initRobotPose.pos.x << " " << this->initRobotPose.pos.y << " " << this->initRobotPose.theta << std::endl;
                 this->setPosition(this->initRobotPose);
                 usleep(200'000);
             }