refact: implement rotation matrices

The functions rotx, roty, rotz are not built-in of MATLAB (wtf). Instead
they come from a very expensive toolbox. As none other function of this
toolbox are needed, the functions are reimplemented manually for Rotare
to remove that useless dependency.