[rotorcraft][guidance] fixes for vertical nav
[rotorcraft] fix takeoff-land-takeoff in nav via flightplan