Python 2d Physics Engine Scratch