From a3221abdbdcfe3f75dc330fb758f98a9c4e664e4 Mon Sep 17 00:00:00 2001 From: ackimixs Date: Fri, 3 May 2024 20:57:21 +0200 Subject: [PATCH] reposition --- TCPServer.cpp | 8 ++++++++ 1 file changed, 8 insertions(+) diff --git a/TCPServer.cpp b/TCPServer.cpp index b37d99b..4649f17 100644 --- a/TCPServer.cpp +++ b/TCPServer.cpp @@ -1271,6 +1271,14 @@ void TCPServer::dropJardiniereFlowers(const StratPattern sp) { this->go(whiteDropPosition); usleep(2'000'000); + // reposition + if (sp == DROP_FLOWER_J1) { + this->setPosition(this->robotPose.pos.x, 140, -PI); + } + else if (sp == DROP_FLOWER_J2) { + this->setPosition(140, this->robotPose.pos.y, 0); + } + this->fullyOpenPince(0); this->fullyOpenPince(2); pinceState[0] = NONE;