Restructuring of code & addition of things

Added rotation matricies and started to fill out RigidBody class. Added
code meant to simulate a physical pendulum and to animate the result,
but it is not all working at the moment.