New branch (stable ardupilot code for PXF)