Implemented homogeneous rotation operator for 4x4 matrices