done sssp algorithm for navigation module