新增充电桩

zhang

2025-05-20 1313906bb1eb983d3beece810035e7fc28d6a92f

 zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/astart/domain/AStarNavigateNode.java

@@ -4,8 +4,8 @@
import lombok.extern.slf4j.Slf4j;

import java.io.Serializable;
import java.util.Objects;
import java.util.Optional;
import java.util.*;
import java.util.stream.Collectors;

/**
 * A*寻路算法Node节点
@@ -100,4 +100,21 @@
        );
    }


    private void print() {
        AStarNavigateNode finishNode = this.clone();
        ArrayList<AStarNavigateNode> navigateNodes = new ArrayList<>();

        while (finishNode != null) {
            navigateNodes.add(finishNode);
            System.out.println("node:" + finishNode.getCodeData() + ", g:" + finishNode.getG() + ", h:" + finishNode.getH() + ", f:" + finishNode.getF());
            finishNode = finishNode.getParent();
        }

        Collections.reverse(navigateNodes);

        List<String> navigatePath = navigateNodes.stream().map(AStarNavigateNode::getCodeData).collect(Collectors.toList());
        System.out.println(navigatePath.toString());
    }

}