Added uniform cost pathfinding