Moved normalize from RotationMatrix to Matrix3d.