adding dis-re-connect calls to USB drv.
Height hold tuning + velocity offset.
do assert()s on ground side code, but not flight.
filter tuning and shinanagins.
added H Hdot pid telemetry and rewrote filter/hpid wiring.
added 2 seconds of orientation measurement averaging at start (to fix startup yaw issue)
gps module on U6. Turned off unused timers that clash with U6.
updating skytraq autogen include with packed structs.
enabling GPS.