This commit is contained in:
ackimixs
2024-05-04 12:07:30 +02:00
parent cf88cc5d45
commit 586ad09dde

View File

@@ -237,7 +237,6 @@ 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(1'000'000);
}
@@ -255,6 +254,8 @@ void TCPServer::handleMessage(const std::string& message, int clientSocket)
this->setSpeed(200);
this->go(this->initRobotPose[0], this->initRobotPose[1]);
switch (this->team) {
case BLUE:
case YELLOW: