Ignore sonar altitude measurements above 3.0m.
Linearly scale baro to sonar on takeoff.