Added method for getting Yaw from a Vector to Utilities.