Port AutoQuad to PX4/Pixhawk, under working