insert pPath into the frontier (keeping the frontier sorted by total distance)
Definition at line 293 of file path.cpp.