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

change aruco finder

Browse Source
This commit is contained in:
ackimixs
2024-04-29 22:45:43 +02:00
parent aa43fcd26b
commit 7e4d1d76a9
4 changed files with 35 additions and 10 deletions
Download Patch File Download Diff File Expand all files Collapse all files

4
utils.cpp
View File

@@ -92,3 +92,7 @@ std::ostream& operator<<(std::ostream& os, const ArucoTag& tag) {
os << "ArucoTag{id=" << tag.id() << ", name=" << tag.name() << ", pos=[" << tag.pos()[0] << ", " << tag.pos()[1] << "], rot=[" << tag.rot()[0] << ", " << tag.rot()[1] << ", " << tag.rot()[2] << "]}";
return os;
}
double distanceToTag(const ArucoTag& tag) {
return std::sqrt(pow(tag.pos()[0], 2) + pow(tag.pos()[1], 2));
}