Apologies for being off topic, I have started it here, if you could help me:
https://discuss.ardupilot.org/t/implementing-a-custom-flight-controller-using-ardupilot-codebase/25237