So I searched my PC and found a copy of a more advanced pathfinder, which can be used for more complex situations like maps with lots of obstacles, other npc's etc.
It was originally made by Blizzard from the Chaos-Project forum, I only made some small edits to make working with Essentials...