Ardupilot

might be what your looking for