First cut of Optimized Path using Dijkstra's shortest path here.