Thanks for this code.
I've wrapped it as a plugin so as to be compatible with the Zen Engine game engine framework and Zen Worlds MMO framework.
I know that moves away from some of your design goals, but if you're interested in the code, check out the Zen Plugins / ZMicroPather source release at https://sourceforge.net/project/showfiles.php?group_id=256190.