Fixed distance heuristic to also calculate recharges required to get to the goal (optimistically)
updated fsplanning