Update PathFinder.py

fixed path estimation greatly improves speed of large maps.