Mavlink (OSD) на двухстрочный дисплей

Есть задача. Взять часть данных Mavlink с APM и вывести их на двухстрочный дисплей. Интересуют результирующие данные крена/тангажа и направления (акселерометр+компас).

Требуемые варианты подключения:
APM (порт телеметрии) -> Arduino+дисплей.
APM (порт телеметрии) <-> модули телеметрии -> Arduino+дисплей.

Из подобных проектов - телеметрия на аппаратуре РУ (линк). А кто-то может проще что видел из готовых решений? Или может кто программисты есть, кто может сделать обработку получения данных из Mavlink на Arduino?

 

Я ничего такого не делал.

Тут проблему надо делить КМК на две части:
1. вытащить из протокола Мавлинк интересующие данные
2. Вывод на целевой дисплей.

По второму вопросу думаю несложно будет. Вот, с ходу нагуглил неплохую статью. (и вот ещё, а вот пошаговая вики)
Думаю Ардуинка Нано справится.

 

По второй части проблем нет.

--- Сообщения объединены, 8 дек 2015 ---

Нашел что-то подобное для чтения данных. https://github.com/DevFor8/Mav2Duplex

 

Это лучше чем я нашел.

 

Может быть ещё чем-нибудь поможет это или это.
Еще нашел проект по дизарму коптера через мавлинк.

 

Видел, что-то там заумное.

Не то.

 

А может зайти со стороны минимОСД?
Старенькое, но зато хоть какие-то исходники.
Или мавлинк для дамми? Точнее, вот ссыль на PDF.