提交距离判断逻辑

3cd9c5c6 · oscar · d198b829 · 3cd9c5c6
Commit 3cd9c5c6 authored Jan 17, 2022 by oscar
Hide whitespace changes
Inline Side-by-side

Showing with 1 addition and 1 deletion

TrackingRosEx.cpp TrackingRosEx.cpp +1 -1

No files found.
--- a/TrackingRosEx.cpp
+++ b/TrackingRosEx.cpp
@@ -587,7 +587,7 @@ void TrackingRos::TrackingCameraCallBackFunc(const jfx_common_msgs::InferResesCo
                    {
                        if (m_front_camera_len != 0)
                        {
-                            if (x < m_front_camera_len && objMsg.type != 4 && objMsg.type != 5)
+                            if ( x*x + y*y  < m_front_camera_len* m_front_camera_len && objMsg.type != 4 && objMsg.type != 5)
                                continue;
                        }
                    }