pathfinding works now
minor fixs