Quick implementation of diagonal heuristic calculation

I've just created a quick implementation of the diagonal heuristic calculation. Just wanted to share if you want to use it.