Start working on swept spheres and cd with spheres
Add ability to calculate penetration vector
Merge branch 'collision_detection'