diff --git a/TCPServer.cpp b/TCPServer.cpp index 92038bf..8cdcc3a 100644 --- a/TCPServer.cpp +++ b/TCPServer.cpp @@ -966,13 +966,14 @@ void TCPServer::dropFlowers() { if (!pinceHavePurpleFlower.empty()) { this->go(purpleDropPosition); awaitRobotIdle(); + + this->setSpeed(150); + this->rotate(PI / 2); awaitRobotIdle(); this->leverBras(); - this->setSpeed(150); - for (auto & toDrop : pinceHavePurpleFlower) { this->openPince(toDrop); usleep(500'000); @@ -997,14 +998,14 @@ void TCPServer::dropFlowers() { this->go(whiteDropPosition); awaitRobotIdle(); + this->setSpeed(130); + this->rotate(PI / 2); awaitRobotIdle(); this->leverBras(); usleep(500'000); - this->setSpeed(130); - this->go(whiteDropPosition[0], 0); usleep(2'000'000);