Was doing nav data all wrong.  Setup test for corrected roll/pitch/yaw values based on NodeCopter output.
Roll/pitch/yaw now parsed correctly
Fix output of roll and pitch
Don't display yaw value we get back from nav data