Выберите Inertial Sensor Fusion Filters

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

Внутренние алгоритмы этих фильтров также варьируются значительно. Например, ecompass возразите использует метод TRIAD, чтобы определить ориентацию платформы с очень низкой стоимостью расчета. Много фильтров (таких как ahrsfilter и imufilter) примите Фильтр Калмана состояния ошибки, в котором оценивается отклонение состояния от ссылочного состояния. Между тем, другие фильтры (такие как insfilterMARG и insfilterAsync) используйте расширенный подход Фильтра Калмана, в котором состояние оценивается непосредственно.

Чтобы достигнуть высокой точности оценки, важно настроить свойства фильтра и параметры правильно. Тулбокс предлагает встроенное tune (Sensor Fusion and Tracking Toolbox) функция к настройкам параметров и шуму датчика для imufilter, ahrsfilter, и insfilterAsync непосредственно.

Таблица приводит входные параметры, выходные параметры, предположения и алгоритмы для всех инерционных фильтров сплава датчика.

Объект Датчики и входные параметрыСостояния и Выходные параметры Предположения или ограничения Используемый алгоритм
ecompass
  • Акселерометр

  • Магнитометр

Ориентация Фильтр не принимает длительного линейного и углового ускорения кроме гравитационного ускорения.Метод TRIAD
ahrsfilter
  • Акселерометр

  • Гироскоп

  • Магнитометр

Ориентация и скорость вращения Фильтр не принимает длительного линейного и углового ускорения кроме гравитационного ускорения.

Фильтр Калмана состояния ошибки

ahrs10filter
  • Акселерометр

  • Гироскоп

  • Магнитометр

  • Высотомер

Ориентация, высота, вертикальная скорость, угловое смещение дельты, скоростное смещение дельты, геомагнитный полевой вектор, смещение магнитометраФильтр принимает кусочное постоянное линейное ускорение в вертикальном направлении и никакое длительное линейное и угловое ускорение кроме гравитационного ускорения в других направлениях.Дискретный расширенный Фильтр Калмана
imufilter
  • Акселерометр

  • Гироскоп

Ориентация и скорость вращения Фильтр не принимает длительного линейного и углового ускорения кроме гравитационного ускорения.Фильтр Калмана состояния ошибки
complementaryFilter
  • Акселерометр

  • Гироскоп

  • (Дополнительный) магнитометр

Ориентация и скорость вращения Фильтр не принимает длительного линейного и углового ускорения кроме гравитационного ускорения.

Основанный на нефильтре Калмана подход:

  • Используйте фильтры высоких частот и фильтры нижних частот, чтобы уменьшать шум в различных показаниях датчика.

  • Плавьте отфильтрованные показания датчика на основе их присвоенных весов.

insfilterMARG
  • Акселерометр

  • Гироскоп

  • Магнитометр

  • GPS

Ориентация, положение, скорость, угловое смещение дельты, скоростное смещение дельты, геомагнитный полевой вектор, смещение магнитометра

Шаг предсказания берет входные параметры гироскопа и акселерометр. Поэтому фильтр принимает:

  • Кусочное постоянное линейное ускорение.

  • Кусочная постоянная угловая скорость.

  • Акселерометр и гироскоп, запущенный на том же уровне без демонстрационного отбрасывания.

Дискретный расширенный Фильтр Калмана
insfilterAsync
  • Акселерометр

  • Гироскоп

  • Магнитометр

  • GPS

Ориентация, скорость вращения, положение, скорость, ускорение, смещение акселерометра, смещение гироскопа, геомагнитный полевой вектор, смещение магнитометра

Фильтр принимает:

  • Постоянная угловая скорость

  • Постоянное ускорение

Фильтр не требует, чтобы датчики были синхронны, и каждый датчик может иметь демонстрационное отбрасывание.

Непрерывный дискретный расширенный Фильтр Калмана
insfilterNonholonomic
  • Акселерометр

  • Гироскоп

  • GPS

Ориентация, положение, скорость, смещение гироскопа, смещение акселерометра

Шаг предсказания берет входные параметры гироскопа и акселерометр. Поэтому фильтр принимает:

  • Кусочное постоянное линейное ускорение.

  • Кусочная постоянная угловая скорость.

  • Акселерометр и гироскоп, запущенный на том же уровне без демонстрационного отбрасывания.

Кроме того, фильтр принимает, что платформа продвигается без заноса.

Дискретный расширенный Фильтр Калмана
insfilterErrorState
  • Акселерометр

  • Гироскоп

  • Магнитометр

  • GPS

  • Визуальная шкала одометрии

Ориентация, положение, скорость, смещение гироскопа, смещение акселерометра и визуальная шкала одометрии

Шаг предсказания берет входные параметры гироскопа и акселерометр. Поэтому фильтр принимает:

  • Кусочное постоянное линейное ускорение.

  • Кусочная постоянная угловая скорость.

  • Акселерометр и гироскоп, запущенный на том же уровне без демонстрационного отбрасывания.

Фильтр Калмана состояния ошибки

Смотрите также

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