Перейти к содержимому
1

53. Датчики: IMU, барометр, магнитометр, оптический поток, ToF #

Автоматический полёт держится на датчиках: IMU даёт угол и скорость 100–1000 Гц, барометр — высоту, магнитометр — курс, оптический поток и ToF-камера — скорость и дистанцию у земли. Разбираем физический принцип каждого, его точность и пределы, и как они объединяются фильтром Калмана.

Содержание

1. Цели статьи

  • Знать физический принцип каждого датчика полётного контроллера и его числовые пределы (диапазон, шум, дрейф).
  • Понимать, почему IMU «плывёт», баро «дышит», компас «боится» моторов — и что это значит для полёта.
  • Понимать, как фильтр Калмана сшивает сигналы в единую оценку позиции/угла.
  • Верно размещать датчики (вибрация, помехи, калибровка) и диагностировать типичные неисправности.
↑ К оглавлению

2. Глоссарий величин

Все величины, используемые в статье, с единицами измерения (СИ):

ВеличинаОбозначениеЕдиницаЧто это
Угловая скоростьω°/с, рад/сГироскоп: диапазон ±2000°/с (≈35 рад/с ≈ 330 об/мин)
Смещение гироскопа (bias)ω_b°/с (градус/с)0,1–2°/с; интегрируется в дрейф: 0,5°/с → 300° за 10 мин
Ускорениеag, м/с²Акселерометр: ±16 g (16 g ≈ 157 м/с²)
Шум гироскопаσ_ω°/√Гц0,1–2 °/√Гц — «полоса» угла, фильтруется прошивкой
Напряжённость магнитного поляBмкТл (микротесла)Геополе Земли 25–65 мкТл; поле моторов 1–10 мкТл на 10–30 см
Точность курсаΔψ° (градус)1–5° после калибровки; 5° → 87 м бокового сдвига на 1 км
Атмосферное давлениеPгПа (гектопаскаль)~1013 гПа у моря; по нему барометр считает высоту
Градиент «давление–высота»—м/гПаУ земли 1 гПа ≈ 8,5 м; на 5 км — 13–15 м (воздух реже)
Точность давленияΔPгПа (гектопаскаль)±0,25–1 гПа → ±2–8 м по высоте (тип.)
Рабочий диапазон потокаhм (метр)Оптический поток: 0,3–5 м от земли; удержание 0,3–1 м
Точность ToF по дистанцииΔd% (см)~2 % от дистанции: 1 м → 2 см, 5 м → 10 см; дальность 0,1–8 м
Частота отсчётаfГц (герц)IMU 400–1000, магнитометр 50–200, баро 50–100, поток 30–60 Гц
↑ К оглавлению

3. IMU: акселерометр и гироскоп

IMU (Inertial Measurement Unit, рисунок — Wikipedia) / Гиростабилизатор — три акселерометра (рисунок — Wikipedia) / Акселерометр (ускорения по X/Y/Z) и три гироскопа (рисунок — Wikipedia) / Гироскоп (угловые скорости по X/Y/Z), выполненные в МЭМС (MEMS)-технологии (рисунок — Wikipedia) / Микроэлектромеханические системы. Это «быстрый» контур: 100–1000 Гц, не зависит от внешних сигналов.

ПараметрТиповое значение (FPV/дрон)Значение для полёта
Диапазон акселерометра±16 g16 g ≈ 157 м/с² — хватает для трюков, ударов, рывков
Диапазон гироскопа±2000°/с (≈35 рад/с)35 рад/с — до ~330 об/мин (5,5 об/с) поворот корпуса
Шум гироскопа0,1–2 °/√Гц«полоса» угла; фильтруется прошивкой
Смещение (bias) гироскопа0,1–2 °/с (зависит от класса)интегрируется в дрейф угла (Задача 1)
Смещение акселерометра0,01–0,1 gошибка угла наклона: 0,01 g ≈ 0,57°
Частота отсчёта400–1000 Гцзадаёт верхний предел контура стабилизации
Частота против точности. Гироскоп — идеальный «краткосрочный» датчик: за 10 мс ошибка мала. Но его выход интегрируется, и постоянный bias накапливается: 0,5°/с → 300° за 10 минут (Задача 1). Поэтому IMU — опорный высокочастотный сигнал, а «долгосрочную» правку дают акселерометр (гравитация — абсолютный ориентир по тангажу/крену), магнитометр (курс) и GNSS (позиция).
↑ К оглавлению

4. Магнитометр (компас)

Магнитометр (рисунок — Wikipedia) / Магнитометр — датчик напряжённости магнитного поля (на Земле ~25–65 мкТл). По горизонтальной компоненте — курс (азимут), по наклону — магнитный наклон (для трёхосной коррекции). Точность курса 1–5° (после калибровки), частота 50–200 Гц.

  • Твёрдое железо (hard iron): постоянное смещение поля (винты, электроника рядом) — «сдвигает» центр эллипсоида калибровки. Устраняется калибровкой.
  • Мягкое железо (soft iron): магнитомягкие элементы искажают форму поля — «сплющивают» эллипсоид. Устраняется частично (коэффициенты калибровки), остальное — отнесением датчика от источника.
  • Помехи от моторов/провода: ток в обмотках и силовых проводах создаёт поле ~1–10 мкТл на 10–30 см (сравнимо с горизонтальной компонентой геополя). Магнитометр размещают на 10–30 см от моторов и ESC, вдали от силовых шин.
↑ К оглавлению

5. Барометр (высотомер)

Барометр (рисунок — Wikipedia) / Барометр измеряет статическое давление; по барометрической формуле давление переводится в высоту. В нижней стратосфере (до ~11 км) связь линейна с хорошим приближением:

ВеличинаЗначениеЗаметка
Градиент (у земли, ISA)≈ 1 гПа ≈ 8,5 му земли; на 5 км воздух реже — 1 гПа ≈ 13–15 м (тот же сдвиг давления — больший по высоте)
Точность датчика±0,25–1 гПа→ ±2–8 м по высоте (тип.)
Динамика50–100 Гц«дышит» от порывов, пропеллерного потока, ветра
Абсолютный ориентирдавление — «абсолютная» высотав отличие от IMU: не накапливает ошибку, но «плывёт» с погодой

Ветер и пропеллерный поток создают пульсации давления ±0,1–0,5 гПа (±1–4 м) — прошивка фильтрует, но «дрожание» высоты 0,3–1 м в удержании — нормальный барометрический вклад.

↑ К оглавлению

6. Оптический поток

Оптический поток (рисунок — Wikipedia) — камера (обычно IR-520 нм с подсветкой), направленная вниз/вниз-назад, 30–60 Гц. Алгоритм отслеживает перемещение «пятен» текстуры между кадрами → горизонтальная скорость и смещение.

  • Рабочий диапазон: 0,3–5 м от земли; ниже 0,3 м текстура уходит из фокуса/засветки, выше 5 м — пятна теряются.
  • Точность удержания: 0,3–1 м (в связке с IMU); сам по себе поток даёт скорость, а не позицию.
  • Условия: нужна текстура (бетон, грунт, трава с тенями); не работает: снег/песок (однородно), зеркала/стекло (нет отражения текстуры), полный мрак без подсветки, скорость выше 10–15 м/с (размытие, Задача 3).
  • Зачем: удержание позиции без GNSS (помехи, подвал, пещера) — 0,3–1 м на 0–5 м от земли; посадка с точностью 0,3–0,5 м.
↑ К оглавлению

7. ToF-камера (time-of-flight)

ToF-камера (рисунок — Wikipedia) / Time-of-Flight-камера измеряет время полёта светового импульса (ИК-940 нм) до цели: d = c·Δt/2. Даёт матрицу расстояний (облако точек 30–160×120–640) со скоростью 15–30 Гц.

  • Дальность: 0,1–8 м (зависит от модели); на 1 м — см, на 5 м — 5–10 см, на 8 м — 10–20 см (Задача 5).
  • Применение: следование рельефу (terrain following) с точностью 0,1–0,3 м; обход препятствий (карта 3D вокруг дрона); точная посадка (расстояние до плоскости 1–2 см у земли); контроль «потолка» в помещении.
  • Ограничения: прямой солнечный свет (ИК-фон заслоняет сигнал — на 8 м точность деградирует); зеркальные/прозрачные поверхности (нет отражения); узкий угол обзора (50–100°) — «слепые зоны» по бокам.
↑ К оглавлению

8. AHRS и фильтр Калмана

AHRS (Attitude and Heading Reference System, рисунок — Wikipedia) / Курсовертикаль — блок, который из сырых сигналов датчиков строит единую оценку: углы (тангаж/крен/рыскание), скорость, позиция, высота. Связующее звено — фильтр Калмана (рисунок — Wikipedia) / Фильтр Калмана (или его упрощённый вариант — комплементарный фильтр).

СигналЧастотаЧто «быстро»/«медленно»Вес в фильтре
Гироскоп400–1000 Гцбыстро (угловые скорости)высокий для угла (краткосрочно)
Акселерометр (гравитация)400–1000 Гцбыстро, но с вибропомехамиправка крена/тангажа (долгосрочно)
Магнитометр50–200 Гцмедленно, помехи от моторовправка курса
Баро50–100 Гцмедленно, «дышит»правка высоты (долгосрочно)
Оптический поток30–60 Гцмедленно, только у землиправка горизонт. скорости/позиции (0–5 м)
GNSS5–25 Гцмедленно, метрыправка позиции (3–10 м; RTK — 10–20 см)
ToF15–30 Гцмедленно, 0,1–8 мправка высоты/дистанции у земли
Суть слияния. «Быстрые» датчики (IMU) задают динамику; «абсолютные» (баро, GNSS, магнитометр) — правят накопленный дрейф. Фильтр Калмана взвешивает по covariance (оценкам ошибки) каждого источника: когда GNSS «плывёт» (помехи), вес автоматически падает, и позиция держится по IMU+поток.
↑ К оглавлению

9. Размещение и помехи

  • IMU: в центре масс (минимальные угловые ускорения), на виброизоляторах (резина/пена 3–5 мм), вдали от моторов и ESC (вибрация 1–100 Гц попадает в полосу акселерометра и «грязнит» угол). Типовые признаки плохой установки: «дрожание» крена в удержании, нестабильность после прогрева (вибрация меняется с температурой).
  • Магнитометр: 10–30 см от моторов/ESC/силовых шин; вдали от железа рамы; после перестановки — повторная калибровка («8-восьмёрка» / «фигура восьмёрки»).
  • Баро: в потоке обтекания (не в закрытом отсеке корпуса), не под пропеллерами (порядок ±0,5 гПа); в полёте — статическое давление (не динамическое).
  • Оптический поток: вниз, с обзора не менее 100°; на FPV-дронах — под фюзеляжем; на мультироторах с углепластиковой рамой — под нижней плитой; углепластик непрозрачен для ИК-излучения 520 нм, поэтому камера должна смотреть через открытое окно рамы.
  • ToF: вниз/вперёд, без «слепых» зон от рамы; на солнце — деградация, на тёмных/зеркальных поверхностях — провал.
↑ К оглавлению

10. Практика: типовые задачи (с решениями)

Задача 1. Дрейф гироскопа

Bias гироскопа 0,5 °/с. На какой угол «уплывёт» рыскание за 10 минут (600 с) без коррекции? Какую роль играет магнитометр в этой ситуации?

Заданные параметры.

ПараметрЗначение
Смещение гироскопа, ω_b0,5 °/с
Время без коррекции10 мин (600 с)
Точность курса магнитометра1–5°

Искомые параметры. Угол дрейфа рыскания (°); роль магнитометра.

Решение.

  1. Δψ = ω_b · t = 0,5 °/с · 600 с = 300°.
  2. Магнитометр — «абсолютный» ориентир по курсу: фильтр Калмана правит накопленный дрейф по магнитному азимуту (точность 1–5°). Без него рыскание «плывёт» линейно.
Ответ: 300° за 10 минут — без коррекции IMU непригоден для курса. Вывод: IMU держит высокочастотную динамику, курс «привязывает» магнитометр — поэтому компас калибруют и защищают от помех.

Задача 2. Баро: гПа в метры

Погодное давление упало на 1 гПа (фронт) за 30 минут. На сколько «сдвинется» барометрическая высота при старте без новой калибровки? Дрон должен держать 100 м.

Заданные параметры.

ПараметрЗначение
Изменение давления, ΔP1 гПа
Градиент (у земли)1 гПа ≈ 8,5 м
Заданная высота удержания100 м

Искомые параметры. Сдвиг барометрической высоты (м).

Решение.

  1. 1 гПа ≈ 8,5 м (у земли).
  2. Без перекалибровки (установка «уровня моря» на старте) барометр покажет +8,5 м «виртуального» сдвига: дрон будет летать на 108,5 м вместо 100 м (или, если калибровка была до смены давления, — на 91,5 м).
Ответ: ±8,5 м. Вывод: калибровка баро (установка QNH/уровня моря) — обязательна перед каждым вылетом; «виртуальный» сдвиг 8,5 м — критичен для облёта объектов и низких миссий.

Задача 3. Оптический поток и размытие

Дрон летит 10 м/с, камера потока 60 Гц. На сколько метров смещается сцена между кадрами? При каком смещении (в долях пятна текстуры 1 см) алгоритм теряет захват?

Заданные параметры.

ПараметрЗначение
Скорость дрона, v10 м/с
Частота кадров, f60 Гц
Размер пятна текстуры1 см

Искомые параметры. Смещение сцены за кадр (м); теряет ли алгоритм захват.

Решение.

  1. Δ = v / f = 10 / 60 = 0,167 м = 16,7 см за кадр.
  2. Пятно текстуры 1 см: смещение 16,7 см = 16,7 пятна — «перескок» больше размера пятна → алгоритм теряет корреляцию (нужен multi-scale/subpixel-алгоритм или снижение скорости). Типовой предел: смещение за кадр менее ~1–2 размеров пятна.
Ответ: 16,7 см/кадр — на пределе/ за пределом для пятна 1 см. Вывод: оптический поток работает на 0–10 м/с; выше — размытие и потеря корреляции; для 20+ м/с нужен GNSS или ToF-скорость.

Задача 4. Ошибка компаса

После калибровки остаточная ошибка магнитометра 5°. Дрон летит по прямой 1 км, курс 090° (восток). На каком боковом смещении от прямой он окажется на дистанции 1 км?

Заданные параметры.

ПараметрЗначение
Остаточная ошибка курса, Δψ5°
Дистанция, L1 км (1000 м)
Курс090° (восток)

Искомые параметры. Боковое смещение от прямой (м).

Решение.

  1. Δy = L · sin(Δψ) = 1000 · sin 5° = 1000 · 0,0872 = 87,2 м.
Ответ: ~87 м. Вывод: 5° по курсу — это «километровые» боковые смещения: для картографии и точных миссий — RTK (статья 51) + коррекция курса по GNSS-вектору, а не только по магнитометру.

Задача 5. ToF: точность по дистанции

ToF-датчик: разрешение 2 % от дистанции. Найти абсолютную ошибку на 1 м и 5 м. Что это значит для следования рельефу (требование — держать 0,3 м над землёй)?

Заданные параметры.

ПараметрЗначение
Разрешение ToF2 % от дистанции
Дистанции для расчёта1 м и 5 м
Требование (следование рельефу)держать 0,3 м над землёй

Искомые параметры. Абсолютная ошибка на 1 м и 5 м (см); допустимость для требования 0,3 м.

Решение.

  1. 2 % · 1 м = 2 см.
  2. 2 % · 5 м = 10 см.
  3. На 1 м — 2 см (хорошо), на 5 м — 10 см: в 3 раза меньше требования 0,3 м — допустимо.
Ответ: 2 см на 1 м; 10 см на 5 м. Вывод: ToF для следования рельефу — рабочий инструмент на 1–5 м; на 8 м (2 % → 16 см) и при прямом солнце точность деградирует — нужен запас высоты.
↑ К оглавлению

11. Чек-лист самопроверки знаний

Отметьте пункты, которые вы действительно понимаете и можете применить без подсказок.

✓НавыкПроверка
IMU±16 g / ±2000°/с; bias 0,5°/с → 300° за 10 мин; виброизоляция
Компасhard/soft iron; 10–30 см от моторов; 5° → 87 м на 1 км
Баро1 гПа ≈ 8,5 м; калибровка QNH перед вылетом; пульсации ±1–4 м
Поток0,3–5 м; текстура; 10 м/с → 16,7 см/кадр (предельно)
ToFd = c·Δt/2; 2% от дистанции; 0,1–8 м; солнце — деградация
AHRSIMU быстро, баро/GNSS/магнитометр правят; фильтр Калмана взвешивает
↑ К оглавлению

12. Источники

  1. Wikipedia, «Inertial measurement unit» — IMU (рисунок). en.wikipedia.org/wiki/Inertial_measurement_unit / ru.wikipedia.org/wiki/Гиростабилизатор (Гиростабилизатор)
  2. Wikipedia, «Accelerometer» — акселерометр (рисунок). en.wikipedia.org/wiki/Accelerometer / ru.wikipedia.org/wiki/Акселерометр (Акселерометр)
  3. Wikipedia, «Gyroscope» — гироскоп (рисунок). en.wikipedia.org/wiki/Gyroscope / ru.wikipedia.org/wiki/Гироскоп (Гироскоп)
  4. Wikipedia, «Microelectromechanical systems» — МЭМС (рисунок). en.wikipedia.org/wiki/Microelectromechanical_systems / ru.wikipedia.org/wiki/Микроэлектромеханические_системы (Микроэлектромеханические системы)
  5. Wikipedia, «Magnetometer» — магнитометр (рисунок). en.wikipedia.org/wiki/Magnetometer / ru.wikipedia.org/wiki/Магнитометр (Магнитометр)
  6. Wikipedia, «Barometer» — барометр (рисунок). en.wikipedia.org/wiki/Barometer / ru.wikipedia.org/wiki/Барометр (Барометр)
  7. Wikipedia, «Optical flow» — оптический поток (рисунок). en.wikipedia.org/wiki/Optical_flow
  8. Wikipedia, «Time-of-flight camera» — ToF-камера (рисунок). en.wikipedia.org/wiki/Time-of-flight_camera / ru.wikipedia.org/wiki/Time-of-Flight-камера (Time-of-Flight-камера)
  9. Wikipedia, «Attitude and heading reference system» — AHRS (рисунок). en.wikipedia.org/wiki/Attitude_and_heading_reference_system / ru.wikipedia.org/wiki/Курсовертикаль (Курсовертикаль)
  10. Wikipedia, «Kalman filter» — фильтр Калмана (рисунок). en.wikipedia.org/wiki/Kalman_filter / ru.wikipedia.org/wiki/Фильтр_Калмана (Фильтр Калмана)
  11. Статьи цикла 51 (GNSS: частоты, точность), 52 (помехи GNSS — резерв по оптическому потоку) — база. Числовые значения (диапазоны, bias, 1 гПа ≈ 8,5 м) — типовые, по открытым спецификациям датчиков и ISA.

Диапазоны (±16 g, ±2000°/с), bias и частоты — типовые для MEMS-датчиков классов «FPV/потребительский–профессиональный»; «1 гПа ≈ 8,5 м» — барометрическая формула у земли (ISA); «0,5°/с → 300° за 10 мин» — расчёт. Проверено: 03.09.2026.

↑ К оглавлению
  • мод. : Воскресенье, 06 сентября 2026