[airborne][fixedwing] #756 Correct altitude setpoint offset during NavGl...

...ide

Fixes issue #756