Refactor robot code to use the (future) new World class (a complete wrapper for Box2D)