From ed3bbcdd7c2fb651e074fd967a45e52a9682adff Mon Sep 17 00:00:00 2001
From: ackimixs <ackimixs@protonmail.com>
Date: Fri, 3 May 2024 18:42:06 +0200
Subject: [PATCH] position

---
 TCPServer.cpp | 7 ++++---
 1 file changed, 4 insertions(+), 3 deletions(-)

diff --git a/TCPServer.cpp b/TCPServer.cpp
index a433d04..01feebd 100644
--- a/TCPServer.cpp
+++ b/TCPServer.cpp
@@ -1294,7 +1294,7 @@ void TCPServer::go3Plants(const StratPattern sp) {
     double angle;
     if (sp == TAKE_3_PLANT_TOP_1) {
         checkpoint = {700, 700};
-        plantPosition = {900, 700};
+        plantPosition = {950, 700};
         angle = 0;
     }
     else if (sp == TAKE_3_PLANT_TOP_2) {
@@ -1304,7 +1304,7 @@ void TCPServer::go3Plants(const StratPattern sp) {
     }
     else if (sp == TAKE_3_PLANT_BOTTOM_1) {
         checkpoint = {700, 1300};
-        plantPosition = {900, 1300};
+        plantPosition = {950, 1300};
         angle = 0;
     } else if (sp == TAKE_3_PLANT_BOTTOM_2) {
         checkpoint = {700, 1300};
@@ -1330,12 +1330,13 @@ void TCPServer::go3Plants(const StratPattern sp) {
 
     this->go(plantPosition);
     awaitRobotIdle();
+    usleep(500'000);
 
     for (int i = 0; i < 3; i++) {
         this->closePince(i);
         pinceState[i] = FLOWER;
     }
-    usleep(200'000);
+    usleep(1'000'000);
 
     this->go(checkpoint);
     awaitRobotIdle();