Added (broken) RigidBody Support

Added RigidBody class, updated forces and force generators to work with
RigidBody. Still no contacts for rigid body, and the rotation code is
all messed up. It has to do with broken matrix transform functions that
I slapped together too hastily.