Scale offboard pos and vel setpoints by 1000. Scale yaw across sizeof UINT16.
Merge branch 'offboard2' into iarc2014_scaleSP
Ignore sonar altitude measurements above 3.0m.
Merge branch 'sonar_alt' into iarc2014