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