Дом АХРС

Принципы, алгоритмы и реализация системы определения ориентации (AHRS)

Новые продукты

Принципы, алгоритмы и реализация системы определения ориентации (AHRS)

June 11, 2025

Получите информацию о товаре за одну минуту!

 

Система координат и положенияСистема AHRS (AHRS) — это ключевое навигационное устройство, использующее слияние данных от нескольких датчиков для расчета в реальном времени трехмерного положения (угла тангажа, угла крена) и угла курса носителя. Ее основные технологии охватывают такие области, как микроэлектромеханические системы (MEMS), инерциальная навигация, обработка сигналов и нелинейная оптимизация. В данной статье будут рассмотрены технические аспекты в трех измерениях: математические модели, реализация алгоритмов и компенсация ошибок.

 

Принципы и кинематические уравнения AHRS

 

Основной принцип AHRS — это слияние данных с нескольких датчиков, которое компенсирует ограничения одного датчика за счет использования дополнительных датчиков.

 

1.Состав датчика:

 

а. Гироскоп: Он измеряет угловую скорость, используя эффект Кориолиса, и интегрирует её для получения изменений ориентации, но при этом отсутствует дрейф смещения (накопленная ошибка во времени).

b. Акселерометр: измеряет удельную силу (ускорение свободного падения + ускорение движения) и может использоваться для калибровки ориентации (крен, тангаж) в статическом режиме или при постоянной скорости.

c. Магнитометр: измеряет направление геомагнитного поля, обеспечивает абсолютное определение курса (угол рыскания), но подвержен влиянию жестких/мягких магнитных помех.

d. Дополнительная функция GPS: помогает корректировать ошибки определения местоположения и скорости.

 

2.Кинематические уравнения

 

Дифференциальное уравнение для обновления угловой скорости и ориентации несущего корабля:

                      Differential equation for carrier angular velocity and attitude update   

Среди них, quaternion multiplicationпредставляет собой умножение кватернионов и the angular velocity measured by the gyroscope (in rad/s)— это угловая скорость, измеренная гироскопом (в рад/с).

 

Основная архитектура и алгоритм AHRS

 

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

 

1.Фильтр Калмана

 

На основе модели пространства состояний ориентация оценивается итеративно посредством прогнозирования (интеграция данных с гироскопа) и обновления (наблюдения с помощью акселерометра/магнитометра).

Построение вектора состояния осуществляется следующим образом, включая угол ошибки ориентации. attitude error angleи смещение гироскопа gyroscope bias.

The construction of the state vector 

В качестве значений наблюдений используются остаточные значения вектора гравитации, измеренные акселерометром, и геомагнитного поля, измеренные магнитометром, и строится следующее уравнение наблюдений:

observation equation

При настройке ковариации используется ковариация шума. the noise covarianceАкселерометр обычно устанавливается на the noise covarianceи ковариация шума магнитометр установлен на the noise covariance.

 

2.Дополнительный алгоритм фильтрации

 

Взвешенное слияние высокочастотных данных гироскопа и низкочастотных данных акселерометра/магнитометра. Его преимущество заключается в низкой вычислительной нагрузке и пригодности для встроенных систем; недостаток состоит в том, что настройка параметров зависит от опыта и имеет ограниченные динамические характеристики.

В высокочастотной части используется интеграция с гироскопом, а в низкочастотной калибровка — акселерометры/магнитометры.

low frequency calibration using accelerometers/magnetometers 

постоянная времени Time constantобычно занимает Time constant

 

3.алгоритм оптимизации градиентного спуска

 

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

Gradient descent optimization algorithm 

Среди них, the convergence rate factor— это коэффициент скорости сходимости, типичные значения которого варьируются от 0,1 до 0,5.

 

Проблемы и меры по внедрению инженерных решений AHRS

 

1.Ошибка датчика и калибровка

 

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

Необходимо корректировать влияние изменений температуры на гироскопы и акселерометры путем создания модели температурной компенсации;

Для компенсации помех, создаваемых магнитометром, необходима жесткая/мягкая магнитная калибровка (подгонка эллипса или алгоритм, основанный на калибровочном поле).

 

2.Динамическая адаптация к окружающей среде

 

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

 

3.Производительность в реальном времени и вычислительные ресурсы

 

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

 

4.Синхронизация и задержка между несколькими датчиками

 

Для сбора данных с датчиков необходима строгая синхронизация по времени, иначе увеличится ошибка слияния. Необходимо компенсировать задержку передачи данных по интерфейсам связи (таким как SPI/I2C).

 

5.Первоначальное выравнивание и устойчивость

 

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

 

Направление дальнейшего развития

 

а. Слияние данных с использованием глубокого обучения: применение нейронных сетей для моделирования сложных ошибок и нелинейных характеристик.

б.Улучшение многоисточникового слияния данных: объединение данных визуального анализа (VIO), GNSS или барометра для повышения надежности в сложных условиях.

с.Прогресс в технологии MEMS: более точные малошумные гироскопы (например, оптические гироскопы MEMS) снизят нагрузку на алгоритмы.

г.Оптимизация граничных вычислений: легковесный алгоритм для встроенных чипов искусственного интеллекта (таких как ARM Cortex-M7).

 

Заключение

 

Технологическая эволюция AHRS по сути представляет собой глубокое переплетение математики, физики и инженерной практики. От решения дифференциальных уравнений с кватернионами в реальном времени до подавления шума в MEMS-датчиках — каждая техническая деталь напрямую влияет на конечные характеристики системы. С улучшением возможностей граничных вычислений и повышением практической применимости высокоточные датчикиследующее поколение АХРС Это позволит достичь восприятия угловых вибраций на нанометровом уровне и полностью автономной защиты от помех, что обеспечит беспилотным системам космическую когнитивную точность, превосходящую человеческую.

Subscibe To Newsletter
Читайте дальше, следите за обновлениями, подписывайтесь, и мы будем рады услышать ваше мнение.
f y

оставить сообщение

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

Дом

Продукты

WhatsApp

Связаться с нами