zhang
6 天以前 29aa7746640d7d0c0f01f3e0d3f23ef3250086a7
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());
    }
}