Find path algorithm introduction,  analysis, implementation and comparison