Pathfinder fix warnings + code review