Finally correct heuristic function! (?)