WIP Rotations made with matrices, on the way to use quaternions
Switch to quaternions to handle rotations of joints
Deleted methods to get the global matrix transformation of a joint