public static double StraightLineDistance( ProblemState <int> stateSrc, ProblemState <int> stateDest) { double totalDist = 0; for (int i = 0; i < stateDest.GetLength(0); i++) { for (int j = 0; j < stateDest.GetLength(1); j++) { totalDist += StraightLineDistance( stateSrc.FindValueIndex(stateDest[i, j]), (i, j)); } } return(totalDist); }