From adaf4e51f496b069feb39866149fb404d12b96de Mon Sep 17 00:00:00 2001 From: luxiaotao1123 <t1341870251@163.com> Date: 星期一, 30 十二月 2024 09:35:33 +0800 Subject: [PATCH] # --- zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/MapService.java | 29 +++++++++++------------------ 1 files changed, 11 insertions(+), 18 deletions(-) diff --git a/zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/MapService.java b/zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/MapService.java index a6cc742..d98b6d3 100644 --- a/zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/MapService.java +++ b/zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/MapService.java @@ -206,7 +206,6 @@ Integer serial = dynamicNode.getSerial(); - long time = dynamicNode.getTime(); List<String> resetCodeList = new ArrayList<>(); @@ -217,7 +216,7 @@ DynamicNode node = dynamicMatrix[i][j]; if (node.getVehicle().equals(agvNo)) { - if (node.getSerial() < serial || node.getTime() != time) { + if (node.getSerial() < serial) { resetCodeList.add(codeMatrix[i][j]); } } @@ -307,26 +306,20 @@ existNodes.add(nextNode); - String nextNodeCodeData = codeMatrix[x][y]; - if (nextNodeCodeData.equals(CodeNodeType.NONE.val)) { + List<Double> o1Cda = MapDataUtils.parseCdaNode(cdaMatrix[originNode.getX()][originNode.getY()]); + List<Double> o2Cda = MapDataUtils.parseCdaNode(cdaMatrix[x][y]); + + if (Math.pow(o1Cda.get(0) - o2Cda.get(0), 2) + Math.pow(o1Cda.get(1) - o2Cda.get(1), 2) <= Math.pow(radiusLen, 2)) { + nextNode.setCodeData(codeMatrix[x][y]); + + if (!nextNode.getCodeData().equals(CodeNodeType.NONE.val)) { + includeList.add(nextNode); + } this.spreadWaveNode(originNode, nextNode, codeMatrix, cdaMatrix, radiusLen, includeList, existNodes); - - } else { - - List<Double> o1Cda = MapDataUtils.parseCdaNode(cdaMatrix[originNode.getX()][originNode.getY()]); - List<Double> o2Cda = MapDataUtils.parseCdaNode(cdaMatrix[nextNode.getX()][nextNode.getY()]); - -// if (Math.pow(o1.getX() - o2.getX(), 2) + Math.pow(o1.getY() - o2.getY(), 2) <= Math.pow(radiusLen, 2)) { - if (Math.pow(o1Cda.get(0) - o2Cda.get(0), 2) + Math.pow(o1Cda.get(1) - o2Cda.get(1), 2) <= Math.pow(radiusLen, 2)) { - nextNode.setCodeData(nextNodeCodeData); - includeList.add(nextNode); - - this.spreadWaveNode(originNode, nextNode, codeMatrix, cdaMatrix, radiusLen, includeList, existNodes); - - } } + } // v2 BFS ------------------------------------------------------------------------------ -- Gitblit v1.9.1