started developing the nested for loops to poppulate the cost map. I am storing in a dictionary all "costs" from all PIDs to all PIDs using the shortestPath function.