Инерциальная навигация
Кратко
Инерциальная навигационная система (INS, ИНС) — способ определять своё положение без каких-либо внешних ориентиров: только по акселерометрам, гироскопам и вычислителю. Система непрерывно счисляет позицию, ориентацию и скорость (dead reckoning — счисление пути), и ей не нужны ни спутники, ни радиомаяки — поэтому инерциальную навигацию не заглушить и не обмануть снаружи. У БПЛА эту роль выполняет IMU с фильтром оценки состояния в полётном контроллере.
Для чего используется
- Непрерывная навигация: инерциальное счисление работает всегда — между обновлениями GNSS, в тоннеле, в помещении, при помехах.
- Основа оценки состояния автопилота: положение и ориентация аппарата в каждый момент времени — это в первую очередь интегрированные данные IMU, скорректированные остальными сенсорами.
- Классика большой техники: инерциальные системы штатно стоят на подводных лодках, самолётах и ракетах — там, где внешняя навигация недоступна или ненадёжна.
Как работает
Принцип — двойное интегрирование: акселерометры измеряют ускорения, интеграл ускорения даёт скорость, интеграл скорости — позицию; гироскопы при этом отслеживают повороты, чтобы вычислитель знал, куда направлены оси акселерометров.
У метода есть фундаментальная плата — дрейф. Малые ошибки измерений интегрируются в растущие ошибки скорости и ещё большие ошибки позиции: даже высококачественные акселерометры накапливают порядка 50 метров ошибки за 17 минут, а у недорогих MEMS-датчиков решение «уплывает» ещё быстрее.
Поэтому современная навигация — гибрид. Инерциальная система даёт непрерывное и быстрое счисление на коротком горизонте, а внешние источники (прежде всего GNSS) регулярно исправляют накопленную ошибку; классический инструмент такого комплексирования — фильтр Калмана.
В открытых автопилотах эту работу выполняет EKF — расширенный фильтр Калмана. В ArduPilot он строит оценку положения, скорости и ориентации из гироскопов, акселерометра, компаса, GPS, датчика воздушной скорости и барометра — и, объединяя все измерения, отбраковывает сбойные данные отдельных сенсоров. К фильтру подключаются и дополнительные источники: оптический поток, дальномеры. Актуальная версия — EKF3; при нескольких IMU параллельно работают несколько «ядер» фильтра, и активным становится то, чьи данные согласованнее (lane switching), а на случай деградации фильтра в фоне живёт резервный алгоритм DCM.
Основные компоненты
- IMU — акселерометры и гироскопы, сырьё инерциального счисления.
- Вычислитель — интегрирует измерения; в дроне это полётный контроллер.
- Фильтр оценки состояния — EKF3 (ArduPilot) / EKF2 (PX4): сплавляет инерциальные данные с корректирующими.
- Корректирующие источники — GNSS, барометр, магнитометр, оптический поток, VIO: сдерживают дрейф.
Примеры
- История: системы наведения ракеты Фау-2, навигация кораблей программы «Аполлон», штатное оснащение подводных лодок.
- Полётный контроллер с несколькими IMU: EKF3 ведёт параллельные ядра по каждому IMU и переключается на самое согласованное — отказ одного датчика не роняет аппарат.
- Кратковременная потеря GPS: аппарат продолжает полёт по инерциальному счислению, пока спутники не вернутся.
Связанные темы
Источники
- Wikipedia — Inertial navigation system — определение, двойное интегрирование, дрейф, история, комплексирование с GNSS.
- ArduPilot Documentation — EKF: сенсоры, отбраковка, EKF3, ядра и lane switching, DCM.