Modified the arduino code to support basic mavlink stuff.

Still needs to be tested
Added Better Static Mapping Algorithm using Moore-Penrose Pseudo
inverses.
Removed unnecessary avr-stl. does not work with teensy
Added Proper Static Map code
Merge branch 'master' of https://github.com/mbartling/TAMU_senior_design.git into mapping