mirror of
https://github.com/modelec/TCPSocketServer.git
synced 2026-03-25 17:10:41 +01:00
add a second step
This commit is contained in:
@@ -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<int>(this->robotPose.pos.x)) + "," + std::to_string(static_cast<int>(this->robotPose.pos.y + 200)) + "\n";
|
||||
/*toSend = "strat;arduino;go;" + std::to_string(static_cast<int>(this->robotPose.pos.x)) + "," + std::to_string(static_cast<int>(this->robotPose.pos.y + 200)) + "\n";
|
||||
this->broadcastMessage(toSend);
|
||||
awaitRobotIdle();
|
||||
|
||||
|
||||
Reference in New Issue
Block a user