AC_PosControl: use cos of pitch target instead of current pitch in accel_to_lean_angles