Merged with newer, cleaned up code, fixed the checksum error
Small corrections
Added option to select port name, minor tweaks to status printing, sacrificied 20 bytes for better status / user debuggability
add integrated part for height controller, tuning gains
Merge remote-tracking branch 'upstream/gps' into develop