[Feature Request] High Efficient Shortest Path Implementation

[zhengsx]

Summary

Calculation of shortest path on CPU would be the bottlenect when batchsize is small. High efficient implementation comparing to current Cython is desired.