[rotorcraft] add some functions to set heading via flight plan

alternative proposal to #702

NavHeading is kept empty as is, since it is used for the heading primitive which currently only makes sense for fixedwings, a todo for later...