Updated pathfinder to stop rounding to nearest grid line