Система стабилизации на MultiWii на 3 Servo

ToxaRU

Здравствуйте.
Пытаюсь придумать систему стабилизации на Arduino nano+героскоп GY-521+магнитометр HMC 5883L+ 3SERVO или два серво и редуктор с моторчиком через драйвер.ну и управление потом ко всему этому(но это потом)

В MultiWii хорошо реализована стабилизация на 2 серво, а вот с 3 осью по магнитометру проблема.

Я новичек совсем в этом деле и прошу подсказать возможно ли вообще в MultiWii как то добавить для стабилизации камеры 3 ось по магнитометру(чтобы держала направление)? Возможно мне стоит обратиться к другим системам типа ArduPirats или еще каким нить?

Помогите пожалуйста-очень нужно. Что почитать,где посмотреть? Неделю сижу готовых решений найти не смог… Буду благодарен за любые полезные советы, ну кроме только “Брось ты это дело”)))