怎么向Ardupilot中添加offboard飞行模式(以ArduSub为例)

ArduSub固件中没有offboard飞行模式,想增加这个飞行模式做自主模式
想用pixhawk做巡游机器人有什么好的办法吗