def heuristicfn(startx, starty, goalx, goaly): return abs(startx - goalx) + abs(starty - goaly) # return pow(((startx//50)-(starty//50)),2) + pow(((goalx//50)-(goaly//50)),2)