Modified Diagonal Traversal

Modified AccumulatedCostAnalysis to use sqrt(2)*costDistance for
diagonal traversals