This commit is contained in:
ackimixs
2024-04-16 12:57:48 +02:00
parent fc7c89eb65
commit ead17853e9

View File

@@ -502,7 +502,7 @@ void TCPServer::goToAruco(const ArucoTag &arucoTag, const int pince) {
this->broadcastMessage(toSend);
double xPrime = arucoTag.pos().first[0] + 40/* - 5*/;
double xPrime = arucoTag.pos().first[0] + 30/* - 5*/ + (decalage * 0.2);
double yPrime = arucoTag.pos().first[1] - decalage;
double thetaPrime = std::atan2(yPrime, xPrime);