From 617a1f27d3160961e4827d577b2d74d0d41d4eaf Mon Sep 17 00:00:00 2001
From: ackimixs <ackimixs@protonmail.com>
Date: Wed, 10 Apr 2024 20:52:06 +0200
Subject: [PATCH] log

---
 TCPServer.cpp | 2 ++
 1 file changed, 2 insertions(+)

diff --git a/TCPServer.cpp b/TCPServer.cpp
index 71ed969..4abf807 100644
--- a/TCPServer.cpp
+++ b/TCPServer.cpp
@@ -340,6 +340,8 @@ void TCPServer::goToAruco(const ArucoTagPos &arucoTagPos, const int pince) {
     double xPrime = arucoTagPos.pos.first[0];
     double yPrime = arucoTagPos.pos.first[1] + decalage;
 
+    std::cout << "Aruco position1 " << xPrime << " " << yPrime << std::endl;
+
     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;