[rotorcraft] add some functions to set heading via flight plan
[rotorcraft] change DEFAULT_CIRCLE_RADIUS to 5m