Add PathFinder algorithm using SPFA