diff options
author | Stanislaw Halik <sthalik@misaki.pl> | 2021-10-15 13:28:00 +0200 |
---|---|---|
committer | Stanislaw Halik <sthalik@misaki.pl> | 2022-03-29 00:04:47 +0200 |
commit | 0ccc1f57d8e0004a6a2facfa79e78c5023fd9853 (patch) | |
tree | 7e2fc6c31b8afeec7e8418e101f7a581a9af3764 /tracker-trackhat/extractor.cpp | |
parent | cdaaba77e9a7152ae884324b9d66391b1c229972 (diff) |
tracker/trackhat: implement extended point metadata
Diffstat (limited to 'tracker-trackhat/extractor.cpp')
-rw-r--r-- | tracker-trackhat/extractor.cpp | 13 |
1 files changed, 4 insertions, 9 deletions
diff --git a/tracker-trackhat/extractor.cpp b/tracker-trackhat/extractor.cpp index aa4d38ef..58b9fd05 100644 --- a/tracker-trackhat/extractor.cpp +++ b/tracker-trackhat/extractor.cpp @@ -8,19 +8,14 @@ void trackhat_extractor::extract_points(const pt_frame& data, { points.clear(); points.reserve(trackhat_camera::point_count); - trackHat_Points_t copy = data.as_const<trackhat_frame>()->points; + const auto& copy = data.as_const<trackhat_frame>()->points; - std::sort(std::begin(copy.m_point), std::end(copy.m_point), - [](trackHat_Point_t p1, trackHat_Point_t p2) { - return p1.m_brightness > p2.m_brightness; - }); - - for (const auto& pt : copy.m_point) + for (const auto& pt : copy) { - if (pt.m_brightness == 0) + if (!pt.ok) continue; constexpr int sz = trackhat_camera::sensor_size; - auto [ x, y ] = to_screen_pos(sz-1-pt.m_x, pt.m_y, sz, sz); + auto [ x, y ] = to_screen_pos(pt.x, pt.y, sz, sz); points.push_back({x, y}); } } |