[flight_plan] set primitive should not delay next stage

Problem: 

in fixedwing, when a block starts with multiple <set commands, each set delays the navigation for 1 nav-tick of 4Hz.

No break: when a set is called, it should not stop the navigation for 1/4 second.

Side effect: a set might be called more than one time