Mathf update and fix

Fixed Mathf.cos() and added convertion from degrees to radians