working progress on more fluent attitude data (roll, pitch). So far I have improved packet prioritization. Added comments and cleaned up code a bit.
Still have problems with ArduPilotMega that I cannot configure its attitude stream to be glitch-free (sometimes I don't get attitude for about 500ms, but othertimes I get update as often as 100ms)