IMPORTANT! I found a bug regarding the direction of rotation in the rotation matrix, you will need to invert your rotations - sorry, My Bad :D