pathfinding working. fix namespace if you like