modelec/detection_pot
1
0
Fork 0
mirror of https://github.com/modelec/detection_pot.git synced 2026-01-20 01:47:30 +01:00
Code Issues Packages Projects Releases Wiki Activity

update with socket

Browse Source
This commit is contained in:
ackimixs
2024-03-20 20:20:00 +01:00
parent 50f4fbcaf1
commit 9bf5502d64
8 changed files with 138 additions and 25 deletions
Download Patch File Download Diff File Expand all files Collapse all files

4
utils/utils.cpp
View File

@@ -1,6 +1,6 @@
#include "utils.h"
double distanceBetweenRobotAndTag(const Type::RobotPose robotPose, const cv::Mat& a)
double distanceBetweenRobotAndTag(Type::RobotPose* robotPose, const cv::Mat& a)
{
return sqrt(pow(robotPose.position.x + a.at<double>(0, 0), 2) + pow(robotPose.position.y + a.at<double>(1, 0), 2) + pow(robotPose.position.z + a.at<double>(2, 0), 2));
return sqrt(pow(robotPose->position.x + a.at<double>(0, 0), 2) + pow(robotPose->position.y + a.at<double>(1, 0), 2) + pow(robotPose->position.z + a.at<double>(2, 0), 2));
}