Modified version of ArduPilot software from FLAIRICS