AC_PosControl: add much of throttle controller