Testing/make anafi flying again

[oyssolbo]

Somewhat big merge. A detailed review is not expected!

A lot of testing about what is reasonable to do within the action-nodes. The drone is flying in the simulator, and is able to plan simple actions online. More advanced plans have not been tested with so far.

The current implementation is a bit hacky however. This is mostly caused by implementing actions directly. Recommendation:

• move each implementation into its own package, using ros2-actions to control these

[oyssolbo]

@simenallum The use of moveby/moveto-command in the move-action, utilizes the drone's internal controller for movement. Over long distances, the movement speed will be somewhat large. It can therefore become difficult to detect available locations for emergency-landing due to the speed