Wrote RotationMatrix3D unit test (start)
Fixed axis rotations
Added equals functions
Fiddled with new rotation calculations