AHRS
- Автор метода
- Aviation heritage
- Год
- 1940s
- Тип
- System
- Семейство
- Attitude Estimation
Этот текст переведён машинным способом и ещё не проверен. Читать оригинал на английском
Что он делает?
Система отсчета курса и углов (AHRS) представляет собой полный инерциальный подсистему навигации, которая оценивает и выдает трехмерную ориентацию (положение) и курс транспортного средства или платформы.
AHRS объединяет измерения от акселерометров, гироскопов и часто магнитометров с помощью алгоритмов слияния данных датчиков (обычно фильтров Калмана или комплементарных фильтров) для обеспечения свободного от дрейфа, быстрого определения положения. AHRS является стандартом в авиации, морской навигации и современных автономных системах.
Интуиция метода
Гироскопы непосредственно измеряют угловые скорости и точны в течение коротких промежутков времени (секунды), но со временем они дрейфуют (интегрирование шума и смещения). Акселерометры определяют гравитацию и стабильны в долгосрочной перспективе, но шумны и не могут напрямую измерять горизонтальное вращение. Компас (магнитометр) измеряет курс относительно магнитного поля Земли, но подвержен локальным искажениям. AHRS объединяет все три датчика, используя сильные стороны каждого: гироскоп для немедленной реакции, акселерометр и компас для долгосрочной стабильности.
История
Ссылки на ориентацию самолета с использованием механических гироскопов появились в 1920-х годах (Sperry). Современные электронные AHRS появились в 1970–1980-х годах с появлением твердотельных датчиков. Интеграция микроэлектромеханических систем (MEMS) гироскопов, акселерометров и магнитометров в 1990–2000-х годах позволила создавать компактные, маломощные AHRS. Усовершенствования алгоритмов (фильтр Мадждвика, фильтр Махони) в 2010-х годах позволили точно определять ориентацию при минимальных вычислительных затратах, что способствовало их внедрению в потребительскую электронику и БПЛА.
Когда применять
Используйте AHRS всякий раз, когда вам нужна информация об ориентации и курсе в реальном времени без дрейфа. Это необходимо для автопилотов самолетов, систем морской навигации, БПЛА, роботов и мобильных устройств. AHRS является основой систем управления полетом, стабилизации и навигации. Развертывайте AHRS, когда отдельные измерения датчиков (только гироскоп, только компас) недостаточны из-за дрейфа или шума. Используйте в любых погодных условиях и условиях освещения (в отличие от систем ориентации на основе зрения).
Ограничения и замечания
- Магнитные помехи; локальные магнитные аномалии (стальные конструкции, электрические системы, бортовая электроника) снижают точность курса; требуется компенсация или повторная калибровка.
- Большие ускорения; во время маневров акселерометр измеряет как гравитационное, так и инерционное ускорение, вызывая ошибки тангажа/крена; фильтр должен использовать модель движения для смягчения последствий.
- Сингулярность (в углах Эйлера); сингулярности при 90-градусном тангаже требуют тщательной численной обработки; кватернионное представление позволяет избежать этого.
- Инициализация; система должна быть неподвижна (или двигаться с известной скоростью) при запуске для инициализации ориентации; динамическая инициализация сложна.
Условия из источника не заменяют независимую научную проверку или валидацию аналитическим движком.
Сильные стороны
- Отсутствие дрейфа в течение длительных периодов; слияние стабильных, но шумных датчиков (акселерометр, компас) с подверженными дрейфу, но быстрыми датчиками (гироскоп) дает стабильную, отзывчивую оценку положения.
- Вычисления в реальном времени; фильтр работает с частотой датчика (100+ Гц), что обеспечивает точные контуры управления.
- Не требуются внешние ссылки; автономная работа, работает в помещении и на улице, днем и ночью.
- Устойчивость к кратковременным шумам датчиков; фильтр естественным образом сглаживает пики измерений, сохраняя при этом отзывчивость.
Применение
- Автопилот и управление полетом самолета: поддерживает ориентацию и курс самолета; обеспечивает ввод данных для алгоритмов автопилота.
- Стабилизация беспилотных летательных аппаратов (БПЛА): обеспечивает управление полетом квадрокоптеров и самолетов.
- Морская навигация и стабилизация: ссылка на курс судна для автопилота и навигации; ввод данных для стабилизации против качки.
- Наведение мобильных роботов и колесных транспортных средств: обеспечивает курс и тангаж/крен для навигации по местности.
- Смартфоны и носимые устройства дополненной реальности: обеспечивает отслеживание ориентации для дисплеев дополненной реальности и распознавания жестов.
Как это работает
Как это работает
Сбор высокочастотных измерений от инерциального измерительного блока (IMU) с 9 степенями свободы (9-DOF): 3-осевой акселерометр, 3-осевой гироскоп и 3-осевой магнитометр, обычно с частотой 50–200 Гц.
Калибровка смещений датчиков, коэффициентов масштабирования и несоосности с использованием статической калибровки или калибровки при известном движении; устранение или компенсация магнитных искажений; точное определение временных меток измерений.
Слияние данных акселерометра и магнитометра (векторные измерения) с данными гироскопа (измерения угловой скорости) с использованием фильтра на основе наблюдателя (комплементарный фильтр или фильтр Калмана) для оценки кватернионной ориентации; вычисление углов Эйлера (крен, тангаж, рыскание) или прямого матричного представления косинусов.
Формула
\vec{q}(t+dt) = \vec{q}(t) + \frac{1}{2}\vec{\omega} \times \vec{q}(t) \cdot dtПоддержание оценки состояния (кватернион или DCM) и ковариации; распространение состояния путем интегрирования данных гироскопа; обновление с использованием измерений акселерометра и компаса, взвешенных по ковариации шума и модели динамики.
Вывод ориентации (тангаж, крен, рыскание или кватернион) и курса (магнитный курс или истинный курс после коррекции склонения) в реальном времени; сообщение о метриках уверенности или точности; сигнализация о магнитных возмущениях или неисправностях датчиков.
Частые ошибки
- Игнорирование магнитной калибровки; некалиброванный магнитометр вносит ошибки курса на 5–10 градусов или более; всегда калибруйте в рабочей среде.
- Неправильная настройка коэффициентов усиления фильтра; слишком быстрая коррекция вызывает дрожание курса; слишком медленная коррекция допускает дрейф; требует эмпирической настройки или адаптивных методов.
- Путаница между магнитным и истинным курсом; магнитное склонение варьируется в зависимости от местоположения; выводите правильный вариант для приложения.
- Предположение, что акселерометр всегда указывает вниз; во время быстрых маневров акселерометр наклонен и не может использоваться для определения ориентации; фильтр должен адаптироваться.
Часто задаваемые вопросы
Что такое сингулярность (gimbal lock) и как ее избежать?
Сингулярность возникает, когда тангаж достигает 90 градусов (например, нос прямо вверх или вниз); при этой сингулярности крен и рыскание становятся зависимыми, и одна степень свободы теряется. Избегайте использования кватернионного представления вместо углов Эйлера для внутренних вычислений; преобразуйте в углы Эйлера только для отображения. Кватернионы свободны от сингулярностей.
Как инициализировать ориентацию AHRS во время динамического движения?
Статическая инициализация (удерживать неподвижно в течение 1–2 секунд) является самой простой. Для динамической инициализации используйте более длинное окно наблюдения (5–10 секунд) с моделью движения, которая предполагает известные маневры или низкое ускорение. Некоторые системы используют GPS-скорость для обнаружения режима движения и применения соответствующей инициализации.
В чем разница между комплементарным фильтром и фильтром Калмана для AHRS?
Комплементарный фильтр является эвристическим и проще в настройке; он фильтрует высокочастотные данные угловой скорости гироскопа и низкочастотные данные акселерометра/компаса. Фильтр Калмана оптимален для линейных систем и естественным образом обрабатывает различные неопределенности датчиков. Фильтр Калмана более надежен, но требует больших вычислительных ресурсов. Для большинства приложений достаточно комплементарного фильтра.
Как обнаружить и исправить магнитные помехи в AHRS?
Отслеживайте показания магнитометра на предмет аномалий (изменение величины, отклонение от ожидаемого поля). Сравнивайте магнитный курс с инерционной оценкой; большое расхождение указывает на помехи. Смягчение последствий: используйте оценку курса по GPS-скорости во время помех, применяйте калибровку мягкого железа/твердого железа или уменьшите вес компаса в фильтре.
Похожие методы
Источники
Savage, P. G. (2007). Strapdown Inertial Integration Technology (2nd ed.). Strapdown Associates.
Открыть ссылку на публикациюСкопировано.Titterton, D. H., & Weston, J. L. (2004). Strapdown Inertial Navigation Technology (2nd ed.). Institution of Engineering and Technology.
Открыть ссылку DOIСкопировано.Madgwick, S. O. H., Harrison, A. J. L., & Vaidyanathan, R. (2011). Estimation of IMU and MARG orientation using a gradient descent algorithm. IEEE International Conference on Rehabilitation Robotics (ICORR), 1–7.
Открыть ссылку на публикациюСкопировано.