shortest path search

[shijiunv]

Bro, a shortest path search function should be better。