From df9508090facadc3abb50ce8f6a96c799038dd8e Mon Sep 17 00:00:00 2001 From: ackimixs Date: Fri, 3 May 2024 12:43:32 +0200 Subject: [PATCH] -20 --- TCPServer.cpp | 2 +- 1 file changed, 1 insertion(+), 1 deletion(-) diff --git a/TCPServer.cpp b/TCPServer.cpp index 2e15043..1ab7819 100644 --- a/TCPServer.cpp +++ b/TCPServer.cpp @@ -683,7 +683,7 @@ void TCPServer::goToAruco(const ArucoTag &arucoTag, const int pince) { auto [xPrime, yPrime] = arucoTag.pos(); double roll = arucoTag.rot()[1]; - auto centerPlantX = (20 * std::cos(roll)) + xPrime; + auto centerPlantX = (20 * std::cos(roll)) + xPrime - 20; auto centerPlantY = (-20 * std::sin(roll)) + yPrime + decalage; double thetaPrime = std::atan2(centerPlantY, centerPlantX);