Tweaked test output
Tweaked test output
Removed launch file
Changed mavlink library to the version that works with updated arduinos
Removed some debugging output
Removed all commented lines