This isn’t a complete solution, but there is some relevant discussion in this thread, which could serve as a starting point if you’re interested in integration with ArduPilot autopilot functionality 
1 Like