From 2b4c25f49fbccc8ce6c7c689a4448492ace6d21a Mon Sep 17 00:00:00 2001 From: ackimixs Date: Wed, 10 Apr 2024 20:48:09 +0200 Subject: [PATCH] log --- TCPServer.cpp | 4 ++-- 1 file changed, 2 insertions(+), 2 deletions(-) diff --git a/TCPServer.cpp b/TCPServer.cpp index 7a35a20..c982bbe 100644 --- a/TCPServer.cpp +++ b/TCPServer.cpp @@ -338,8 +338,8 @@ void TCPServer::goToAruco(const ArucoTagPos &arucoTagPos, const int pince) { this->broadcastMessage(toSend); - double xPrime = arucoTagPos.pos.second[0]; - double yPrime = arucoTagPos.pos.second[1] + decalage; + double xPrime = arucoTagPos.pos.first[0]; + double yPrime = arucoTagPos.pos.first[1] + decalage; double x = (xPrime * std::cos(robotPose.theta) + yPrime * std::sin(robotPose.theta)) + this->robotPose.pos.x; double y = (-xPrime * std::sin(robotPose.theta) + yPrime * std::cos(robotPose.theta)) + this->robotPose.pos.y;