Цифровые компасы, магнитное поле Земли и калибровка.
Про цифровые (электронные) компасы и Землю
Электронный компас измеряет интенсивность магнитного поля (величину магнитной индукции) по своим трём осям: X, Y и Z.
Для моего компаса направления такие:
X - вперёд
Y - направо
Z - вниз
Для компаса в моём смартфоне они другие. Если смотреть на экран в портретной ориентации:
X - направо по экрану
Y - вверх по экрану
Z - на меня
Интенсивность магнитного поля Земли в разных местах разная, от 0,25 до 0,65 Гс (Гауссов), на экваторе меньше, у полюсов больше.
Вектор (индукции) магнитного поля земли направлен в сторону магнитного севера и, в северном полушарии, отчасти вниз. Чем севернее широта, тем более вниз.
Для южного полушария - наоборот, вверх.
Про калибровку
Калибровка электронного компаса должна производиться при изменении географического положения, изменении внешних источников магнитного поля и изменении источников магнитного поля "на борту" рядом с компасом.
При калибровке компас измеряет максимально и минимально возможные значения по каждой своей оси и, с помощью коэффициентов, делает их минимумы и максимумы одинаковыми.
Для этого придуманы разные способы, и все они требуют, чтобы компас физически вращался в разных плоскостях и побывал в разных возможных ориентациях.
Если компас будет использоваться только в горизонтальном положении, то ось Z не влияет на результаты и достаточно, чтобы только по осям X и Y прибор мог измерить максимальную и минимальную интенсивность.
Для этого и используется "магическая восьмёрка", когда человек берёт смартфон в руку и описывает большую "8" примерно в горизонтальной плоскости. При этом рука сама будет ещё и переворачивать смартфон экраном вверх и вниз. При этом компас не примет всех возможных положений, но этот способ даст компасу достаточно хорошую картину максимальных и минимальных значений поля по X и Y.
Компасу, который должен точно показывать направление в самых разных положениях, надо проводить более полную калибровку. Для этого его надо направлять в каждую из 6 возможных сторон (вверх, вниз, вперёд, назад, направо, налево) и вращать вокруг оси выбранного направления. Делать полный оборот (360°) - желательно, но не строго обязательно, так как этот способ калибровки обладает некоторой избыточностью.
Про показания компаса
Направления указаны для "моего" компаса.
В горизонтальном положении направление "на север" можно посчитать, взяв арктангенс от значений Y и X, то есть arctan(Y/X) с сохранением знака Y для полученного угла.
При вращении откалиброванного компаса в горизонтальной плоскости:
Z зависит от широты (больше по модулю ближе к полюсам) и при вращении совсем не меняется. У меня Z = 0.5 Гс (или -0.5 на смартфоне)
При направлении на север X максимальный, а Y = 0
При направлении на юг X минимальный, а Y = 0
При направлении на запад Y максимальный, а X = 0
При направлении на восток Y минимальный, а X = 0
Максимальные отклонения X и Y от 0 должны быть на одинаковые величины в плюс и в минус, и должны совпадать у осей X и Y.
Величина максимальных отклонений X и Y зависит от географической широты и несколько уменьшается при приближении к полюсам Земли. У меня X и Y меняются от -0.15 Гс до +0.15 Гс
Если вращать компас на горизонтальной поверхности с одной скоростью, то значения X и Y будут описывать синусоиды, а их фазы будут отличаться на четверть периода (π/2).
При этом горизонтальность положения должна определяться или пользователем, или акселерометром (лучше вместе с гироскопом), закреплённым рядом с компасом.
Но если положение компаса не горизонтальное - в дело включается более сложная тригонометрия. Здесь необходимы правильные значения по оси Z. А также, здесь необходима информация об угле отклонения от горизонтали, что должно обеспечиваться акселерометром/гироскопом, закреплённым вместе с компасом. Точность показаний компаса очень сильно зависит от точности информации о наклоне компаса! Так происходит потому что вертикальная компонента магнитного поля (особенно сильная ближе к полюсам Земли) при наклоне компаса "перевешивает" горизонтальные. И если считать направление "горизонтальным" способом, то легко получить результат, практически противоположный истинному.

Но ведь если компас заранее трехмерный, то ему должно быть пофиг как он стоит? Он может это вычислить при калибровке, соотнося замеренное поле с показаниями акселерометров?
ReplyDeleteНужно ли компасу принимать сигнал GPS, чтобы получать какую-то справочную информацию о состоянии магнитного поля в его районе?
Так-то компас - это тупая коробочка, регулярно выдающая 3 значения. Это я для упрощения писал "компас делает то, считает это".
DeleteВ моём случае всё, кроме самих измерений, делают мозги дрона. Гироскоп+акселерометр находится в них же. А они были ориентированы слегка не так, как компас, и не знали об этом.
Ориентацию компаса можно было бы узнать таким способом, только если заранее знать, какие "правильные" значения он должен получать при какой ориентации. Даже если у нас будет точнейшая карта магнитного поля для Земли и мы будем знать наши координаты, то всё равно мы не будем знать об искажениях для компаса "на борту", от других приборов с магнитным полем.
Алгоритм такой калибровки получается сложный и неточный, поэтому он и не реализован =)
Да, в PX4 по умолчанию реализовано получение магнитного склонения по GPS-координатам.