AC_PosControl: modify accel_to_lean_angles to apply filters before yaw rotation