Minor cleanup of Pathfinder

Removed a redundant line and added two sanity asserts