Begin writing final report.
Calculate everything in a separate function. Get the true path of the pedestrian to compare against IGP's path.
Calculate scores for IGP and ground truth based on path length and safety.