Rv collisions

Added model and state classes that can hopefully be used both for rendering and the motion planning. Most of the code added here is c++, but since I'm not familiar with many best practices for c++ some things may need changing.