Add a working collision system

Now need to implement the colliders, but the collision system is up and
running !