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

I think this should cause the copter to take a straight(er) path to the target tilt angle.