mirror of
https://github.com/modelec/TCPSocketServer.git
synced 2026-01-19 00:47:36 +01:00
exclude bad plant
This commit is contained in:
@@ -743,6 +743,12 @@ void TCPServer::handleArucoTag(ArucoTag &tag) {
|
||||
return;
|
||||
}
|
||||
|
||||
auto rotArray = tag.rot();
|
||||
|
||||
if (rotArray[2] > 0.3 && rotArray[2] < -0.3 && rotArray[0] > 3 && rotArray[0] < 2.5) {
|
||||
return;
|
||||
}
|
||||
|
||||
for (auto& t : arucoTags) {
|
||||
if (tag.id() == t.id()) {
|
||||
float tPosX = t.pos()[0];
|
||||
|
||||
Reference in New Issue
Block a user