Testing normalize method for RotationMatrix. Also had to add length() method to Vector3d and added a test for it.