This commit is contained in:
ackimixs
2024-05-04 11:37:22 +02:00
parent 3adeaf1e30
commit d77f5e1739

View File

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