RotationMatrix Tests

Unsuccessful tests with the rotation matrices. Will try more tomorrow.