В. Яценко - Твой первый квадрокоптер - теория и практика

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

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

Разумеется, акселерометры измеряют не только ускорение свободного падения, но и линейные ускорения по любой из осей при движении квадрокоптера. В ряде случаев эта информация тоже бывает полезна.

С другой стороны, когда надо быстро определить скорость и знак углового ускорения, проще использовать гироскоп, который так же выдает эти данные более точно и в готовом виде. Таким образом, каждый сенсор хорош для своей задачи. В современных MEMS-микросхемах трехосевые гироскопы и трехосевые акселерометры часто объединяют в одном корпусе с размерами около 3x3x1 мм. В этом же корпусе находится электронная схема для предварительной цифровой обработки данных, с внешним протоколом обмена SPI или I 2С.

Чтобы определить курсовое направление рамы квадрокоптера, нужен еще один датчик — интегральный компас , или магнитометр . Квадрокоптер может лететь как угодно, вбок, назад, или по диагонали, поэтому "вперед" в нашем случае — это условное направление рамы и контроллера, относительно которого определяется фактическое направление полета. На плате контроллера направление "вперед" обычно обозначается стрелкой.

Принцип работы интегрального магнитометра (компаса)

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

Рис. 2.4. Устройство интегрального магнитометра

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

Рис. 2.5. Магнитометр HMC5883Lна плате расширения

Магнитометры не подвержены вибрации, но на их показания влияют внешние близко расположенные металлические предметы. Помехи можно разделить на три основных класса.

• "Искажения твердого железа" (Hard Iron Distortion) — к магнитному полю земли добавляется постоянное магнитное поле от намагниченных предметов, например магнита звукоизлучателя. Намагниченными могут быть даже выводы радиодеталей, изготовленные из луженого железа. Эта постоянная составляющая может быть исключена при калибровке.

• "Искажения мягкого железа" (Soft Iron Distortion) — магнитное поле искажается посторонними предметами, не имеющими собственной намагниченности. Например, сплавы никеля, пермаллой искажают силовые линии поля. Такие искажения зависят от положения объекта в пространстве и труднее компенсируются. К счастью, в конструкции квадрокоптера обычно не бывает таких предметов. Детали из сплавов алюминия и меди не вносят искажения.