Removed the checkCollisionWithVisualization functions and cleaned up the CollisionSpace a bit. It's still dirty and needs to be designed better.