Implemented A* to return a WorldPos list (should be converted to actions before used)