fix pathfinding
add a goal