I made custom pathfinding solution before. How about considering my project too ?
https://github.com/Farer/bw_path_finding