reposition

This commit is contained in:
ackimixs
2024-05-03 20:57:21 +02:00
parent 3bc4bd0895
commit a3221abdbd

View File

@@ -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;