Added more methods to RotationMatrix and Matrix3d.