Allow custom rigid body class to cleanup data.
Use std::list instead of vector for entity tracking