Fixed problem in util
Change quaternion creation from angle axis
Added quaternion to matrix functions
Fix quaternion to matrix4 function
Add matrix to quaternion conversion