One thing missing is a physics engine/collision response. Sounds hard but not really. Only implement the collision response after you have implemented collision

One thing missing is a physics engine/collision response. Sounds hard but not really. Only implement the collision response after you have implemented collision detection.