[fixedwing] nav function to downlink WP after computation
[nav] Set Alt and Pos here