diff --git a/TCPServer.cpp b/TCPServer.cpp index c597256..8306daf 100644 --- a/TCPServer.cpp +++ b/TCPServer.cpp @@ -603,11 +603,11 @@ void TCPServer::startGameBlueTeam() { this->broadcastMessage("strat;arduino;angle;157\n"); awaitRobotIdle(); + this->broadcastMessage("strat;servo_moteur;lever bras;1\n"); + this->broadcastMessage("strat;arduino;go;762,0\n"); usleep(3'000'000); - this->broadcastMessage("strat;servo_moteur;lever bras;1\n"); - for (int i = 0; i < 3; i++) { if (pinceState[i] == WHITE_FLOWER) { toSend = "strat;servo_moteur;ouvrir pince;" + std::to_string(i) + "\n"; @@ -633,7 +633,7 @@ void TCPServer::startGameBlueTeam() { * Handle the second plant spot */ - toSend = "strat;arduino;go;" + std::to_string(static_cast(this->robotPose.pos.x)) + "," + std::to_string(static_cast(this->robotPose.pos.y + 200)) + "\n"; + /*toSend = "strat;arduino;go;" + std::to_string(static_cast(this->robotPose.pos.x)) + "," + std::to_string(static_cast(this->robotPose.pos.y + 200)) + "\n"; this->broadcastMessage(toSend); awaitRobotIdle();