[Skzdog_autopilot_setpoin topic] Created :)
[Skydog_autopilot] Added almost everything needed to make it work
[Skydog_path_planning] Added almost everything needed to make it work