Enhancing Feature Tracking Reliability for Visual Navigation using Real-Time Safety Filter

Fuente: arXiv
Salvato in:
Dettagli Bibliografici
Autori principali: Kim, Dabin, Jang, Inkyu, Han, Youngsoo, Hwang, Sunwoo, Kim, H. Jin
Natura: Preprint
Pubblicazione: 2025
Soggetti:
Accesso online:
Tags: Aggiungi Tag
Nessun Tag, puoi essere il primo ad aggiungerne!!
_version_ 1866910810553450496
author Kim, Dabin
Jang, Inkyu
Han, Youngsoo
Hwang, Sunwoo
Kim, H. Jin
author_facet Kim, Dabin
Jang, Inkyu
Han, Youngsoo
Hwang, Sunwoo
Kim, H. Jin
contents Vision sensors are extensively used for localizing a robot's pose, particularly in environments where global localization tools such as GPS or motion capture systems are unavailable. In many visual navigation systems, localization is achieved by detecting and tracking visual features or landmarks, which provide information about the sensor's relative pose. For reliable feature tracking and accurate pose estimation, it is crucial to maintain visibility of a sufficient number of features. This requirement can sometimes conflict with the robot's overall task objective. In this paper, we approach it as a constrained control problem. By leveraging the invariance properties of visibility constraints within the robot's kinematic model, we propose a real-time safety filter based on quadratic programming. This filter takes a reference velocity command as input and produces a modified velocity that minimally deviates from the reference while ensuring the information score from the currently visible features remains above a user-specified threshold. Numerical simulations demonstrate that the proposed safety filter preserves the invariance condition and ensures the visibility of more features than the required minimum. We also validated its real-world performance by integrating it into a visual simultaneous localization and mapping (SLAM) algorithm, where it maintained high estimation quality in challenging environments, outperforming a simple tracking controller.
format Preprint
id arxiv_https___arxiv_org_abs_2502_01092
institution arXiv
publishDate 2025
record_format arxiv
spellingShingle Enhancing Feature Tracking Reliability for Visual Navigation using Real-Time Safety Filter
Kim, Dabin
Jang, Inkyu
Han, Youngsoo
Hwang, Sunwoo
Kim, H. Jin
Robotics
Computer Vision and Pattern Recognition
Systems and Control
Vision sensors are extensively used for localizing a robot's pose, particularly in environments where global localization tools such as GPS or motion capture systems are unavailable. In many visual navigation systems, localization is achieved by detecting and tracking visual features or landmarks, which provide information about the sensor's relative pose. For reliable feature tracking and accurate pose estimation, it is crucial to maintain visibility of a sufficient number of features. This requirement can sometimes conflict with the robot's overall task objective. In this paper, we approach it as a constrained control problem. By leveraging the invariance properties of visibility constraints within the robot's kinematic model, we propose a real-time safety filter based on quadratic programming. This filter takes a reference velocity command as input and produces a modified velocity that minimally deviates from the reference while ensuring the information score from the currently visible features remains above a user-specified threshold. Numerical simulations demonstrate that the proposed safety filter preserves the invariance condition and ensures the visibility of more features than the required minimum. We also validated its real-world performance by integrating it into a visual simultaneous localization and mapping (SLAM) algorithm, where it maintained high estimation quality in challenging environments, outperforming a simple tracking controller.
title Enhancing Feature Tracking Reliability for Visual Navigation using Real-Time Safety Filter
topic Robotics
Computer Vision and Pattern Recognition
Systems and Control
url https://arxiv.org/abs/2502.01092