Adding Dughi's pathfind.cc, which should have some new nav primitives;
intermed while we get it working