Cleanup

Removed uncessary comments/code. Added some extra comments.

There is still unused code in drawAxesAndCube.
We currently don’t use Rodrigues, or the entire extrinsic matrix.