Handle trajectory solver faults

[Charles-Poly]

Currently, if no trajectory is found, SwarmController will go in hover state.

Possible improvements:

• Try again with a bigger distance between agents
• Modify traj. solver parameters
• ...