Changed how the cost to move is calculated. It now uses the Diagonal Distance method