Added class and it's utils classes for calculating shortest path