Added Collision Detection code and set up for a benchmark.