Code changed to calculate yaw in degrees.