Corrected Atan2 function for AccYangle