Remake Gridsystem and pathfinding