From 25eb3b2bbb05cb598e9082000ef1217b8bb39166 Mon Sep 17 00:00:00 2001 From: ackimixs Date: Tue, 30 Apr 2024 12:02:11 +0200 Subject: [PATCH] speed --- TCPServer.cpp | 2 -- 1 file changed, 2 deletions(-) diff --git a/TCPServer.cpp b/TCPServer.cpp index a5b444a..455c443 100644 --- a/TCPServer.cpp +++ b/TCPServer.cpp @@ -675,10 +675,8 @@ void TCPServer::goToAruco(const ArucoTag &arucoTag, const int pince) { double thetaPrime = std::atan2(centerPlantY, centerPlantX); - this->setSpeed(150); this->rotate(this->robotPose.theta /*+ rotate*/ - thetaPrime); awaitRobotIdle(); - this->setSpeed(200); double robotPosForPotX = (centerPlantX * std::cos(theta) + centerPlantY * std::sin(theta)) + robotPosX; double robotPosForPotY = (-centerPlantX * std::sin(theta) + centerPlantY * std::cos(theta)) + robotPosY;