FailsafeController: handle the failsafe correctly at higher modalities (velocity, position)

[klaxalk]

• What should failsafe do with the Position modality? Is it even reasonable to have it trigger? Should it just ehover or eland?
• The same with velocity modality.