Collision first try

Complete (I think) functional collision detection system. Still maybe some tests to do but I have to implement the collision resolution before anymore testing.