From d77f5e1739c903cf77097f5363b459512cbabb04 Mon Sep 17 00:00:00 2001
From: ackimixs <ackimixs@protonmail.com>
Date: Sat, 4 May 2024 11:37:22 +0200
Subject: [PATCH] spawn

---
 TCPServer.cpp | 1 +
 1 file changed, 1 insertion(+)

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);
             }