I started working on a new pathfinder

My attempts at optimizing the old one were futile...