some initial sonar fixes

we might need a different throttle PID for sonar hold altitude, because
the "standard" PID values that are used for baro doesn't apply in this
case