Навигация без GPS: коротко о технологии VIO (Visual Inertial Odometry)
Физика процесса
Представьте, что вы с закрытыми глазами пытаетесь пройти по квартире, лишь изредка на долю секунды открывая их. Ваш вестибулярный аппарат (чувство ускорения и поворота) - это и есть инерциальные датчики IMU: акселерометр измеряет линейное ускорение, гироскоп – угловую скорость. Мгновенные вспышки зрения - это камера. Мозг, который совмещает эти два потока данных, чтобы понять, куда и как далеко вы переместились, - это алгоритм VIO.
Принцип работы
Точно так же алгоритм VIO работает в реальном времени, обрабатывая два параллельных потока данных:
1. Визуальная одометрия:
- Камера робота делает снимки с высокой частотой (например, 30-60 кадров в секунду).
- Алгоритм находит и отслеживает особые точки (feature points) на соседних кадрах (углы, контрастные пятна).
- По смещению этих точек между кадрами вычисляется ориентировочное перемещение и поворот камеры.
2. Инерциальная одометрия:
IMU работает с еще большей частотой (200-1000 Гц).
- Путем математического интегрирования данных гироскопа получается ориентация (углы крена, тангажа, рыскания).
- Путем двойного интегрирования данных акселерометра (с вычетом гравитации) получается перемещение и скорость.
Недостатки: этот метод быстро накапливает ошибки (дрейф).
3. Слияние и коррекция ошибок:Здесь вступает в действие сложный математический фильтр, чаще всего фильтр Калмана или оптимизация на графах.
- IMU дает очень точные данные о поворотах и кратковременных ускорениях, но его данные о позиции быстро «плывут».
- Камера дает точные данные о относительном перемещении между кадрами, но плохо справляется с быстрыми чистыми вращениями или в однородной среде (белые стены).
- Алгоритм VIO объединяет эти данные: Использует высокочастотные данные IMU для сглаживания и предсказания, а данные с камеры — для частой коррекции накопившегося дрейфа IMU. В результате получается плавная, точная и высокочастотная оценка позиции с шестью степенями свободы (положение + ориентация).
Вывод:
VIO - перспективная технология, которая уже сегодня сделала возможной автономную навигацию там, где раньше она была немыслима.
Источник: