Create function "mag_estimate_yaw_angle"