From 449e4e9df08162b1e7e04ac0d4e05a1387298171 Mon Sep 17 00:00:00 2001 From: Junjie <fallin.jie@qq.com> Date: 星期二, 08 七月 2025 16:48:16 +0800 Subject: [PATCH] # --- src/main/java/com/zy/common/utils/ShuttleOperaUtils.java | 139 ++++++++++++++++++++++++++++++++++++++------- 1 files changed, 116 insertions(+), 23 deletions(-) diff --git a/src/main/java/com/zy/common/utils/ShuttleOperaUtils.java b/src/main/java/com/zy/common/utils/ShuttleOperaUtils.java index 9292a44..45f6a71 100644 --- a/src/main/java/com/zy/common/utils/ShuttleOperaUtils.java +++ b/src/main/java/com/zy/common/utils/ShuttleOperaUtils.java @@ -6,8 +6,8 @@ import com.zy.asrs.entity.BasShuttle; import com.zy.asrs.service.BasShuttleService; import com.zy.asrs.utils.Utils; +import com.zy.common.model.MapNode; import com.zy.common.model.NavigateNode; -import com.zy.common.model.enums.NavigationMapType; import com.zy.core.News; import com.zy.core.cache.SlaveConnection; import com.zy.core.dispatcher.ShuttleDispatchUtils; @@ -260,19 +260,30 @@ continue; } - int nextInt = new Random().nextInt(outerNodes.size()); - NavigateNode randomNode = outerNodes.get(nextInt); - String randomLocNo = NavigatePositionConvert.nodeToLocNo(randomNode); - shuttleDispatchUtils.dispatchShuttle(null, randomLocNo, shuttleNo); + String targetLocNo = null; + for (NavigateNode node : outerNodes) { + String dispatchLocNo = NavigatePositionConvert.nodeToLocNo(node); + //鑾峰彇鍐呭湀鑺傜偣 + List<NavigateNode> avoidInnerNodes = getInnerNodes(dispatchLocNo, innerCircle, new ArrayList<>()); + //璁$畻鍐呭湀鏄惁鏈夊皬杞� + List<Integer> avoidNodesCar = findNodesCar(avoidInnerNodes); + if(!avoidNodesCar.isEmpty()) { + continue; + } + targetLocNo = dispatchLocNo; + break; + } + + if(targetLocNo == null) { + continue; + } + shuttleDispatchUtils.dispatchShuttle(null, targetLocNo, shuttleNo); } return true;//鍐呭湀涓湁杞� } - //鎼滅储鑺傜偣鍐呯殑灏忚溅缂栧彿 - private List<Integer> findNodesCar(List<NavigateNode> nodes) { - List<Integer> list = new ArrayList<>(); - + private HashMap<String, Integer> findCarMap() { HashMap<String, Integer> carMap = new HashMap<>(); for (ShuttleSlave slave : slaveProperties.getShuttle()) { ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, slave.getId()); @@ -290,7 +301,13 @@ carMap.put(currentLocNo, slave.getId()); } + return carMap; + } + //鎼滅储鑺傜偣鍐呯殑灏忚溅缂栧彿 + private List<Integer> findNodesCar(List<NavigateNode> nodes) { + List<Integer> list = new ArrayList<>(); + HashMap<String, Integer> carMap = findCarMap(); for (NavigateNode node : nodes) { String locNo = NavigatePositionConvert.nodeToLocNo(node); if (carMap.containsKey(locNo)) { @@ -307,14 +324,16 @@ int lev = Utils.getLev(locNo); int[] pointArr = NavigatePositionConvert.positionToXY(locNo); NavigateNode currentNode = new NavigateNode(pointArr[0], pointArr[1]); + currentNode.setZ(lev); - int[][] map = navigateMapData.getDataFromRedis(lev, NavigationMapType.NORMAL.id, null, whiteShuttlePointList); + List<List<MapNode>> lists = navigateMapData.getJsonData(lev, -1, null, null);//鑾峰彇瀹屾暣鍦板浘 + int[][] map = navigateMapData.parseJsonDataArr(lists); int nodeValue = map[pointArr[0]][pointArr[1]]; currentNode.setNodeValue(nodeValue); for (int i = 0; i < outerCircle; i++) { int idx = i + 1; - List<NavigateNode> list = extend_nodes(map, currentNode, idx); + List<NavigateNode> list = extend_outer_nodes(map, currentNode, idx); if (list.isEmpty()) { continue; } @@ -348,23 +367,37 @@ currentNode.setZ(lev); innerNodes.add(currentNode); - int[][] map = navigateMapData.getDataFromRedis(lev, NavigationMapType.NORMAL.id, null, whiteShuttlePointList); + List<List<MapNode>> lists = navigateMapData.getJsonData(lev, -1, null, null);//鑾峰彇瀹屾暣鍦板浘 + int[][] map = navigateMapData.parseJsonDataArr(lists); int nodeValue = map[pointArr[0]][pointArr[1]]; currentNode.setNodeValue(nodeValue); for (int i = 0; i < innerCircle; i++) { int idx = i + 1; - List<NavigateNode> list = extend_nodes(map, currentNode, idx); + List<NavigateNode> list = extend_inner_nodes(map, currentNode, idx); if (list.isEmpty()) { continue; } - innerNodes.addAll(list); + + for (NavigateNode node : list) { + boolean flag = false; + for (int[] shuttlePoint : whiteShuttlePointList) { + if(node.getX() == shuttlePoint[0] && node.getY() == shuttlePoint[1]) { + flag = true; + break; + } + } + if(flag) { + continue; + } + innerNodes.add(node); + } } return innerNodes; } - private List<NavigateNode> extend_nodes(int[][] map, NavigateNode startNode, int innerCircleIdx) { + private List<NavigateNode> extend_inner_nodes(int[][] map, NavigateNode startNode, int innerCircleIdx) { //榛樿鍦板浘姣嶈建鏂瑰悜x String mapDirection = "x"; ConfigService configService = SpringUtils.getBean(ConfigService.class); @@ -389,13 +422,17 @@ NavigateNode node = new NavigateNode(x + innerCircleIdx, y); node.setNodeValue(map[x + innerCircleIdx][y]); node.setZ(z); - nodes.add(node); + if (node.getNodeValue().equals(startNode.getNodeValue())) { + nodes.add(node); + } } if (is_valid(map, x - innerCircleIdx, y)) { NavigateNode node = new NavigateNode(x - innerCircleIdx, y); node.setNodeValue(map[x - innerCircleIdx][y]); node.setZ(z); - nodes.add(node); + if (node.getNodeValue().equals(startNode.getNodeValue())) { + nodes.add(node); + } } } @@ -405,14 +442,18 @@ NavigateNode node = new NavigateNode(x, y + innerCircleIdx); node.setNodeValue(map[x][y + innerCircleIdx]); node.setZ(z); - nodes.add(node); + if (node.getNodeValue().equals(startNode.getNodeValue())) { + nodes.add(node); + } } if (is_valid(map, x, y - innerCircleIdx)) { NavigateNode node = new NavigateNode(x, y - innerCircleIdx); node.setNodeValue(map[x][y - innerCircleIdx]); node.setZ(z); - nodes.add(node); + if (node.getNodeValue().equals(startNode.getNodeValue())) { + nodes.add(node); + } } } }else if (mapDirection.equals("y")) {//姣嶈建y鏂瑰悜 @@ -422,14 +463,18 @@ NavigateNode node = new NavigateNode(x, y + innerCircleIdx); node.setNodeValue(map[x][y + innerCircleIdx]); node.setZ(z); - nodes.add(node); + if (node.getNodeValue().equals(startNode.getNodeValue())) { + nodes.add(node); + } } if (is_valid(map, x, y - innerCircleIdx)) { NavigateNode node = new NavigateNode(x, y - innerCircleIdx); node.setNodeValue(map[x][y - innerCircleIdx]); node.setZ(z); - nodes.add(node); + if (node.getNodeValue().equals(startNode.getNodeValue())) { + nodes.add(node); + } } } @@ -439,13 +484,17 @@ NavigateNode node = new NavigateNode(x + innerCircleIdx, y); node.setNodeValue(map[x + innerCircleIdx][y]); node.setZ(z); - nodes.add(node); + if (node.getNodeValue().equals(startNode.getNodeValue())) { + nodes.add(node); + } } if (is_valid(map, x - innerCircleIdx, y)) { NavigateNode node = new NavigateNode(x - innerCircleIdx, y); node.setNodeValue(map[x - innerCircleIdx][y]); node.setZ(z); - nodes.add(node); + if (node.getNodeValue().equals(startNode.getNodeValue())) { + nodes.add(node); + } } } }else { @@ -455,6 +504,50 @@ return nodes; } + private List<NavigateNode> extend_outer_nodes(int[][] map, NavigateNode startNode, int innerCircleIdx) { + ArrayList<NavigateNode> nodes = new ArrayList<>(); + int x = startNode.getX(); + int y = startNode.getY(); + int z = startNode.getZ(); + + if (is_valid(map, x + innerCircleIdx, y)) { + NavigateNode node = new NavigateNode(x + innerCircleIdx, y); + node.setNodeValue(map[x + innerCircleIdx][y]); + node.setZ(z); + if (node.getNodeValue().equals(startNode.getNodeValue())) { + nodes.add(node); + } + } + + if (is_valid(map, x - innerCircleIdx, y)) { + NavigateNode node = new NavigateNode(x - innerCircleIdx, y); + node.setNodeValue(map[x - innerCircleIdx][y]); + node.setZ(z); + if (node.getNodeValue().equals(startNode.getNodeValue())) { + nodes.add(node); + } + } + + if (is_valid(map, x, y + innerCircleIdx)) { + NavigateNode node = new NavigateNode(x, y + innerCircleIdx); + node.setNodeValue(map[x][y + innerCircleIdx]); + node.setZ(z); + if (node.getNodeValue().equals(startNode.getNodeValue())) { + nodes.add(node); + } + } + + if (is_valid(map, x, y - innerCircleIdx)) { + NavigateNode node = new NavigateNode(x, y - innerCircleIdx); + node.setNodeValue(map[x][y - innerCircleIdx]); + node.setZ(z); + if (node.getNodeValue().equals(startNode.getNodeValue())) { + nodes.add(node); + } + } + return nodes; + } + private boolean is_valid(int[][] map, int x, int y) { if (x < 0 || x >= map.length || y < 0 || y >= map[0].length) { -- Gitblit v1.9.1