diff --git a/TCPServer.cpp b/TCPServer.cpp index 81bad47..277b7be 100644 --- a/TCPServer.cpp +++ b/TCPServer.cpp @@ -558,6 +558,8 @@ void TCPServer::startGameBlueTeam() { this->broadcastMessage("strat;arduino;angle;314\n"); awaitRobotIdle(); + usleep(1'000'000); + toSend = "strat;arduino;go;" + std::to_string(static_cast(this->robotPose.pos.x - 350)) + "," + std::to_string(static_cast(this->robotPose.pos.y)) + "\n"; this->broadcastMessage(toSend); awaitRobotIdle();