Detect outliers by joint group distances.

2025-03-25 13:39:03 +01:00
parent 71968d06fd
commit 49a8855e03
2 changed files with 174 additions and 34 deletions
--- a/rpt/triangulator.hpp
+++ b/rpt/triangulator.hpp
@ -138,6 +138,10 @@ private:
        std::vector<std::vector<std::array<float, 4>>> &poses,
        const std::vector<std::string> &joint_names);

+    void replace_far_joints(
+        std::vector<std::vector<std::array<float, 4>>> &poses,
+        const std::vector<std::string> &joint_names);
+
    // Statistics
    double num_calls = 0;
    double total_time = 0;