Add diagonal cost variable for A* rerouting algorithm. Diagonal cost is modifiable via GridConstants.DIAGONAL_PATH_COST.
Merge origin/master