[flight_plan] set primitive should not delay next stage

when a set is called, it should not stop the navigation for 1/4 second.
[flight_plan] fix return primitive