Магнитометр (компас) дрона
Синонимы: компас дрона, магнитный компас БВС, magnetometer, mag
Магнитометр (компас) дрона — датчик магнитного поля Земли, по которому полётный контроллер определяет курс аппарата: в какую сторону развёрнут нос относительно севера.
Магнитометр (компас) дрона — датчик магнитного поля Земли, по которому полётный контроллер определяет курс: куда развёрнут нос аппарата относительно севера. Это единственный бортовой источник абсолютного направления, поэтому калибровка компаса дрона входит в предполётные процедуры. Поле Земли слабое, 25–65 мкТл, и рядом лежащее железо сбивает показания.
Что измеряет магнитометр и где он стоит
Физически это микросхема размером с рисовое зерно, измеряющая проекции вектора магнитного поля на три оси. Прошивка берёт горизонтальную составляющую и считает угол между ней и продольной осью аппарата — получается курс. В массовой технике встречаются IST8310, QMC5883L, LIS3MDL, AK09916, RM3100: все поддерживаются открытыми прошивками вроде ArduPilot и различаются шумом и ценой, а не принципом.
Полезный сигнал очень слабый. По данным NOAA полная напряжённость геомагнитного поля у поверхности Земли лежит в пределах примерно 25 000–65 000 нТл, то есть 25–65 мкТл, а горизонтальная составляющая, по которой считается курс, ещё меньше. Намагниченное железо или проводник с током рядом с датчиком создаёт поле того же порядка. Отсюда растут все беды компаса.
Стоит магнитометр в одном из двух мест. Внутренний — прямо на плате полётного контроллера, в сантиметрах от силовых дорожек и разъёма аккумулятора. Внешний — в модуле спутниковой антенны, который выносят на мачте над рамой. Внешний почти всегда честнее: поле магнита падает с расстоянием по кубу, поле провода — обратно пропорционально ему, так что каждый сантиметр выноса работает на точность.
Почему без компаса курс уплывает
Ориентацию делят между собой три датчика. Акселерометр чувствует вектор тяжести и потому знает, где низ, — из него берутся крен и тангаж. Гироскоп меряет угловые скорости, но его показания приходится интегрировать, а погрешность накапливается: это дрейф, разобранный в термине инерциальная навигация. Рыскание — единственный угол, который гравитация не подпирает: наклон акселерометр поймает, а разворот вокруг вертикальной оси — нет.
Магнитометр закрывает ровно эту дыру: даёт абсолютный курс по внешнему ориентиру, к которому фильтр ориентации подтягивает интеграл гироскопа. Спутники тут не помощники — GPS и ГЛОНАСС дают координату и вектор путевой скорости, а не разворот корпуса. Пока аппарат летит вперёд, курс примерно совпадает с направлением движения. В висении, на боковом сносе ветром и при полёте хвостом вперёд эта подсказка пропадает.
Чем оборачивается ошибка курса, видно на возврате. В режиме RTH аппарат считает вектор на точку старта в географических осях и переводит его в команду «лететь вперёд» через собственный курс. Ошибка в 30 градусов превращает возврат в полёт по дуге мимо точки; ошибка в 180 градусов уводит борт в противоположную сторону, и оператор наблюдает, как дрон уверенно уходит за горизонт.
Что сбивает компас: железо, ток и ЛЭП
Помехи делятся на две группы. Жёсткое железо (hard iron) — постоянные магниты и намагниченные детали самого аппарата: магниты моторов, динамик, защёлка подвеса, стальной крепёж. Они добавляют к измерению постоянное смещение, которое путешествует вместе с дроном. Мягкое железо (soft iron) — ферромагнитные массы без собственной намагниченности: они искажают внешнее поле, и ошибка зависит от того, как повёрнут аппарат. Первое лечится сдвигом нуля, второе — коэффициентами по осям.
Отдельная история — ток. Поле вокруг прямого проводника считается как B = μ₀·I / (2π·r): при токе 1 А на расстоянии 1 см выходит около 20 мкТл, половина типичного земного поля. Силовая проводка FPV-борта в разгоне тянет десятки ампер, и датчик в пяти сантиметрах от неё ловит наводку в сотни микротесла — больше полезного сигнала. Наводка меняется вместе с газом, поэтому курс уплывает именно на разгоне.
| Источник помехи | Что делает с курсом | Что делает оператор |
|---|---|---|
| Арматура в плите, люки, рельсы | Искажение на конкретной точке, меняется при развороте борта | Не взлетать и не калиброваться с плиты, уйти на грунт |
| Капот и крыша автомобиля | Сильное локальное поле, курс уходит на десятки градусов | Не раскладывать аппарат на машине, взлёт с земли |
| Магниты моторов и силовые провода | Ошибка растёт вместе с током, курс плывёт на разгоне | Вынести датчик на мачту, прогнать компенсацию по току |
| Опоры и провода ЛЭП | Стальная масса опоры плюс поле токов линии | Держать дистанцию, смотреть телеметрию |
| Телефон, рация, ключи в кармане | Смещение нуля при калибровке уезжает в параметры борта | Убрать металл и электронику перед процедурой |
Про ЛЭП стоит сказать точнее: обследование линий — рабочая задача для дрона. Замеры поля промышленной частоты под высоковольтными линиями у земли дают единицы микротесла, в открытых публикациях приводятся значения порядка 5–13 мкТл. На фоне земных 25–65 мкТл это заметно, но курс само по себе не переворачивает. Опаснее другое: решётчатая опора — многотонная ферромагнитная масса, искажающая поле в радиусе метров, а при подлёте вплотную к проводу расстояние до тока падает до метра и меньше. Оценочно поле у жилы с током в сотни ампер там сопоставимо с земным или больше; точной цифры по месту не знает никто, поэтому закладывают запас по дистанции.
Калибровка компаса дрона: что она делает и когда нужна
Калибровка компаса дрона не чинит обстановку вокруг. Она снимает слепок собственного магнитного поля аппарата: вы вращаете борт во всех плоскостях, прошивка собирает облако измерений и подгоняет под него эллипсоид. Смещение центра — жёсткое железо, форма — мягкое. Поправки остаются в параметрах и вычитаются из каждого измерения. Влияние арматуры под ногами запишется туда же — в этом главный подвох процедуры.
Отсюда правило, которое переворачивает привычку новичка: калибровка «на всякий случай» перед каждым вылетом вредна. Прогнав её на плите с арматурой или на крыше машины, вы зашили чужое поле в поправки борта — и в чистом поле компас станет врать сильнее, чем врал до процедуры.
- Выберите открытую площадку: грунт или трава, десяток метров и больше до построек, машин, заборов, люков и опор линий.
- Уберите телефон, ключи, нож, рацию, отложите пульт — при вращении руки находятся в сантиметрах от датчика.
- Запустите процедуру и сделайте полный оборот в горизонте, затем полный оборот с опущенным носом: так датчик увидит поле со всех сторон.
- Если прошивка показывает числа, посмотрите на них: в ArduPilot смещение любой оси выше 600 — признак помехи, а не норма.
- Если процедура срывается второй раз подряд на разных точках, ищите железо на самом борту, а не повторяйте её по кругу.
Для аппаратов с внутренним магнитометром в ArduPilot есть отдельная процедура компенсации наводки от тока — CompassMot. Документация проекта даёт понятные пороги: наводка меньше 30 процентов от полного поля — нормально, 31–60 процентов — серая зона с непредсказуемым поведением, больше 60 процентов — датчик надо переносить или ставить внешний.
Как понять, что компас врёт
Грубый отказ прошивка ловит сама: сообщение об ошибке компаса, отказ взлетать, переход в режим без удержания позиции — у DJI это ATTI, когда борт держит высоту, но висит по ветру. Опаснее мягкая ошибка в десятки градусов: аппарат летит, предупреждений нет, а поведение уже неправильное.
- «Унитаз» (toilet bowl effect) — в удержании позиции аппарат наматывает расходящуюся спираль: контроллер видит снос по спутникам и парирует его не в ту сторону.
- Доворот сразу после отрыва: борт подпрыгивает и разворачивается на десятки градусов, пока фильтр сводит гироскоп и компас.
- Полёт «крабом»: команда «вперёд» уводит аппарат по диагонали, а не вдоль оси.
- Стрелка курса на карте смотрит не туда, куда физически развёрнут борт на площадке.
- Возврат домой начинается в сторону от точки старта и правится вручную.
Проверить подозрение можно на земле, без полёта. Поставьте аппарат носом вдоль дороги или стены с понятной ориентацией, сравните курс в телеметрии с картой, затем отнесите борт на двадцать метров и повторите. Разброс в десятки градусов между точками означает, что мешает площадка; одинаковая ошибка в обеих — сам борт или сбитая ориентация внешнего датчика.
Когда дрон обходится без магнитометра
Гоночные и фристайл-борта магнитометра часто не имеют вовсе, и это осознанный выбор. В ручном режиме курс держит сам пилот по картинке с камеры, а прошивке абсолютное направление на север не нужно — она стабилизирует угловые скорости по гироскопу. К тому же гоночный аппарат — худшее место для компаса: короткие силовые провода, десятки ампер, плотная компоновка. Как только на борт ставят удержание позиции, автовозврат или полёт по точкам, вопрос курса возвращается.
Крупная техника решает задачу иначе — двумя разнесёнными спутниковыми антеннами. Приёмник сравнивает фазу сигнала на них и определяет направление базы между антеннами, то есть курс, вообще без магнитного поля. Способ невосприимчив к железу и току и потому прижился на агродронах и съёмочных бортах с высокоточным позиционированием; плата — вторая антенна, жёсткая база и цена.
Что проверяет оператор перед вылетом
Компас редко ломается и часто врёт. Дисциплина на площадке даёт здесь больше, чем любые настройки в прошивке.
- Площадка: грунт или трава, а не плита с арматурой; аппарат не лежит на капоте и не стоит на люке.
- Карманы пустые, телефон и рация в стороне; во время калибровки к аппарату никто не подходит.
- Курс в приложении совпадает с реальным разворотом борта — проверено глазами до взлёта.
- После отрыва — несколько секунд висения на метре: аппарат не доворачивает сам и не описывает круги.
- Рядом с ЛЭП, ангаром и забором держится дистанция, автоматические режимы не включаются.
Чтение показаний датчиков, разбор логов и предполётные процедуры — часть практической программы обучения операторов БПЛА. На учебном борте ошибку курса видно сразу; в поле её обычно замечают уже по улетевшему аппарату.
Частые вопросы
Как часто нужно калибровать компас дрона?
Реже, чем принято думать. Калибровка не улучшает компас сама по себе — она заново измеряет собственное магнитное поле аппарата и записывает поправки. Если борт не менялся и обстановка вокруг датчика прежняя, старые поправки остаются верными, а новая процедура только даёт шанс записать в них помеху с площадки.
Разумный список поводов короткий: первая настройка после сборки; замена или перестановка узлов рядом с датчиком — модуля спутниковой антенны, регуляторов, силовой проводки, лотка аккумулятора; смена рамы; жёсткая посадка с ударом; переезд на другой регион за тысячу и более километров, где заметно отличаются склонение и наклонение поля; прямое требование прошивки или сообщение об ошибке компаса. Во всех остальных случаях перед вылетом достаточно убедиться, что стрелка курса в приложении совпадает с реальным разворотом борта на площадке.
Можно ли калибровать компас дома, в гараже или на балконе?
Нет, и это одна из самых частых ошибок новичка. В жилом доме и в гараже вокруг вас арматура в перекрытиях, стальные балки, трубы, проводка под нагрузкой, холодильник, колонки, инструмент. Процедура добросовестно измерит всю эту обстановку и сохранит её как собственное поле аппарата.
Результат выглядит парадоксально: калибровка проходит успешно, дрон в гараже показывает ровный курс, а в чистом поле ведёт себя хуже, чем до процедуры, — потому что теперь он вычитает из измерений поле, которого там нет. Правильная площадка — открытый грунт или трава, десяток метров и больше до построек, машин, заборов, люков и линий электропередачи. Асфальт обычно нейтрален, а бетонная плита с арматурой и брусчатка на металлическом основании — нет. Если открытой площадки нет, лучше отложить калибровку до выезда, чем провести её в помещении.
Дрон пишет «ошибка компаса» прямо на точке вылета — что делать?
Сначала отойти. В большинстве случаев виновата площадка, а не борт: люк под ногами, арматура в плите, машина в двух метрах, металлический забор, опора линии. Поднимите аппарат, перенесите на двадцать-тридцать метров в сторону, поставьте на грунт и перезапустите питание. Если сообщение исчезло, дело было в месте, и калибровать ничего не нужно.
Если ошибка держится на любой точке, проверяйте сам борт: не сдвинулся ли модуль спутниковой антенны, не прижались ли к нему силовые провода, не появился ли рядом стальной крепёж или магнитная защёлка подвеса, не перепутана ли ориентация внешнего датчика после переустановки. Калибровку имеет смысл прогонять только на чистой площадке и только после этой проверки. Если прошивка показывает смещения по осям, держите в голове ориентир ArduPilot: значение выше 600 говорит о помехе, а не о норме, и такой результат принимать нельзя.
Почему дрон кружит расходящейся спиралью в режиме удержания позиции?
Это классический «унитаз» (toilet bowl effect), и в подавляющем большинстве случаев за ним стоит ошибка курса. Удержание точки работает так: спутники дают смещение от заданной позиции в географических осях, компас сообщает, как развёрнут борт, и по этим двум величинам считается, в какую сторону наклониться. Если курс смещён, коррекция уходит не туда, снос нарастает, и аппарат наматывает круги, которые расходятся.
Первые подозреваемые — калибровка, выполненная в плохом месте, сдвинувшийся или неверно ориентированный внешний датчик, наводка от силовой проводки, растущая вместе с током. Реже причина другая: перекос тяги из-за повреждённого или неправильно поставленного винта даёт похожую картину. Действия в воздухе простые — переведите аппарат в ручной режим, выйдите из спирали, посадите борт и разбирайтесь на земле, а не пытайтесь пересилить автоматику стиками.
Опасны ли ЛЭП для компаса дрона при обследовании линий?
Опасны, но не так, как обычно думают. Переменное поле промышленной частоты под высоковольтной линией у земли по открытым замерам составляет единицы микротесла — публикуемые значения лежат в районе 5–13 мкТл, что на фоне земных 25–65 мкТл заметно, но курс само по себе не переворачивает.
Настоящих источников ошибки два. Первый — решётчатая стальная опора: многотонная ферромагнитная масса искажает поле вокруг себя на метры, и ошибка меняется по мере облёта конструкции. Второй — близкий подлёт к проводу: поле вокруг проводника убывает обратно пропорционально расстоянию, и на дистанции около метра от жилы с током в сотни ампер оно оценочно сопоставимо с земным или превышает его. Точную величину по месту заранее не знает никто — она зависит от нагрузки линии и от того, насколько компенсируют друг друга поля фаз. Поэтому на обследовании держат дистанцию, не полагаются на автоматические режимы вплотную к проводам и следят за поведением курса в телеметрии.
Почему на гоночных FPV-дронах магнитометра часто нет?
Потому что он там не нужен и вдобавок работал бы плохо. В ручном режиме курс держит пилот по картинке с камеры: он видит горизонт и ориентиры, а прошивке абсолютное направление на север ни для чего не требуется — она стабилизирует угловые скорости по гироскопу. При этом гоночный борт — худшее окружение для магнитометра: короткие силовые провода, десятки ампер в разгоне, плотная компоновка, где датчик физически негде отнести от тока.
Компас появляется тогда, когда появляются режимы, которым нужен внешний ориентир: удержание позиции, автоматический возврат домой, полёт по заданным точкам, следование за объектом. В этом случае его ставят в модуль спутниковой антенны и выносят на мачту подальше от силовой части. Промежуточный вариант для дальнолётов — магнитометр есть, но его показаниями пользуется только автоматика, а основной полёт идёт в ручном режиме.
Компас дрона показывает на магнитный или на географический север?
Датчик меряет магнитное поле и потому видит магнитный север. Разница между ним и географическим называется магнитным склонением и в разных точках планеты составляет от долей градуса до десятков градусов. Прошивка учитывает её самостоятельно: по координатам со спутникового приёмника она берёт склонение из зашитой модели геомагнитного поля и вводит поправку, так что курс в телеметрии оператор видит уже географический.
Две оговорки. Первая: модель описывает плавное глобальное поле и не знает локальных магнитных аномалий от залежей железной руды — Курская магнитная аномалия тому известный пример, там поле заметно отличается от модельного, и поправка окажется неточной. Вторая: пока приёмник не поймал координаты, склонение брать неоткуда, и прошивка работает с последним известным значением. Лечится и то, и другое одинаково: не доверять автоматическим режимам вслепую и сверять курс с реальным разворотом борта перед взлётом.