Skip to content
Назад к результатам поиска

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+ Гц), что обеспечивает точные контуры управления.
  • Не требуются внешние ссылки; автономная работа, работает в помещении и на улице, днем и ночью.
  • Устойчивость к кратковременным шумам датчиков; фильтр естественным образом сглаживает пики измерений, сохраняя при этом отзывчивость.

Применение

  • Автопилот и управление полетом самолета: поддерживает ориентацию и курс самолета; обеспечивает ввод данных для алгоритмов автопилота.
  • Стабилизация беспилотных летательных аппаратов (БПЛА): обеспечивает управление полетом квадрокоптеров и самолетов.
  • Морская навигация и стабилизация: ссылка на курс судна для автопилота и навигации; ввод данных для стабилизации против качки.
  • Наведение мобильных роботов и колесных транспортных средств: обеспечивает курс и тангаж/крен для навигации по местности.
  • Смартфоны и носимые устройства дополненной реальности: обеспечивает отслеживание ориентации для дисплеев дополненной реальности и распознавания жестов.

Как это работает

Как это работает

1

Сбор высокочастотных измерений от инерциального измерительного блока (IMU) с 9 степенями свободы (9-DOF): 3-осевой акселерометр, 3-осевой гироскоп и 3-осевой магнитометр, обычно с частотой 50–200 Гц.

2

Калибровка смещений датчиков, коэффициентов масштабирования и несоосности с использованием статической калибровки или калибровки при известном движении; устранение или компенсация магнитных искажений; точное определение временных меток измерений.

3

Слияние данных акселерометра и магнитометра (векторные измерения) с данными гироскопа (измерения угловой скорости) с использованием фильтра на основе наблюдателя (комплементарный фильтр или фильтр Калмана) для оценки кватернионной ориентации; вычисление углов Эйлера (крен, тангаж, рыскание) или прямого матричного представления косинусов.

Формула
\vec{q}(t+dt) = \vec{q}(t) + \frac{1}{2}\vec{\omega} \times \vec{q}(t) \cdot dt
4

Поддержание оценки состояния (кватернион или DCM) и ковариации; распространение состояния путем интегрирования данных гироскопа; обновление с использованием измерений акселерометра и компаса, взвешенных по ковариации шума и модели динамики.

5

Вывод ориентации (тангаж, крен, рыскание или кватернион) и курса (магнитный курс или истинный курс после коррекции склонения) в реальном времени; сообщение о метриках уверенности или точности; сигнализация о магнитных возмущениях или неисправностях датчиков.

Частые ошибки

  • Игнорирование магнитной калибровки; некалиброванный магнитометр вносит ошибки курса на 5–10 градусов или более; всегда калибруйте в рабочей среде.
  • Неправильная настройка коэффициентов усиления фильтра; слишком быстрая коррекция вызывает дрожание курса; слишком медленная коррекция допускает дрейф; требует эмпирической настройки или адаптивных методов.
  • Путаница между магнитным и истинным курсом; магнитное склонение варьируется в зависимости от местоположения; выводите правильный вариант для приложения.
  • Предположение, что акселерометр всегда указывает вниз; во время быстрых маневров акселерометр наклонен и не может использоваться для определения ориентации; фильтр должен адаптироваться.

Часто задаваемые вопросы

Что такое сингулярность (gimbal lock) и как ее избежать?

Сингулярность возникает, когда тангаж достигает 90 градусов (например, нос прямо вверх или вниз); при этой сингулярности крен и рыскание становятся зависимыми, и одна степень свободы теряется. Избегайте использования кватернионного представления вместо углов Эйлера для внутренних вычислений; преобразуйте в углы Эйлера только для отображения. Кватернионы свободны от сингулярностей.

Как инициализировать ориентацию AHRS во время динамического движения?

Статическая инициализация (удерживать неподвижно в течение 1–2 секунд) является самой простой. Для динамической инициализации используйте более длинное окно наблюдения (5–10 секунд) с моделью движения, которая предполагает известные маневры или низкое ускорение. Некоторые системы используют GPS-скорость для обнаружения режима движения и применения соответствующей инициализации.

В чем разница между комплементарным фильтром и фильтром Калмана для AHRS?

Комплементарный фильтр является эвристическим и проще в настройке; он фильтрует высокочастотные данные угловой скорости гироскопа и низкочастотные данные акселерометра/компаса. Фильтр Калмана оптимален для линейных систем и естественным образом обрабатывает различные неопределенности датчиков. Фильтр Калмана более надежен, но требует больших вычислительных ресурсов. Для большинства приложений достаточно комплементарного фильтра.

Как обнаружить и исправить магнитные помехи в AHRS?

Отслеживайте показания магнитометра на предмет аномалий (изменение величины, отклонение от ожидаемого поля). Сравнивайте магнитный курс с инерционной оценкой; большое расхождение указывает на помехи. Смягчение последствий: используйте оценку курса по GPS-скорости во время помех, применяйте калибровку мягкого железа/твердого железа или уменьшите вес компаса в фильтре.

Похожие методы

Источники

  1. Savage, P. G. (2007). Strapdown Inertial Integration Technology (2nd ed.). Strapdown Associates.

    Открыть ссылку на публикацию
    Скопировано.
  2. Titterton, D. H., & Weston, J. L. (2004). Strapdown Inertial Navigation Technology (2nd ed.). Institution of Engineering and Technology.

    Открыть ссылку DOI
    Скопировано.
  3. 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.

    Открыть ссылку на публикацию
    Скопировано.