Code changes after testing directly on the boat; APM forbids a parallel utilisation so a solution with mavlink must be found with the same design