From ae0d613e60b2308d23b2760d514d0ff3356bfa48 Mon Sep 17 00:00:00 2001 From: Junjie <fallin.jie@qq.com> Date: 星期六, 14 十月 2023 09:06:23 +0800 Subject: [PATCH] # --- src/main/java/com/zy/asrs/utils/Utils.java | 190 +++++++++++++++++++++++++++++++++++++++++----- 1 files changed, 167 insertions(+), 23 deletions(-) diff --git a/src/main/java/com/zy/asrs/utils/Utils.java b/src/main/java/com/zy/asrs/utils/Utils.java index 3ef6d92..1ef6d12 100644 --- a/src/main/java/com/zy/asrs/utils/Utils.java +++ b/src/main/java/com/zy/asrs/utils/Utils.java @@ -1,9 +1,40 @@ package com.zy.asrs.utils; import com.alibaba.fastjson.JSON; +import com.baomidou.mybatisplus.mapper.EntityWrapper; import com.core.common.Arith; import com.core.common.Cools; +import com.core.common.SpringUtils; +import com.zy.asrs.entity.BasShuttle; +import com.zy.asrs.entity.LocMast; +import com.zy.asrs.entity.WrkMast; +import com.zy.asrs.mapper.WrkMastMapper; +import com.zy.asrs.service.BasShuttleService; +import com.zy.asrs.service.LocMastService; +import com.zy.asrs.service.WrkMastService; +import com.zy.asrs.service.impl.MainServiceImpl; +import com.zy.common.model.NavigateNode; +import com.zy.common.model.enums.NavigationMapType; +import com.zy.common.service.CommonService; +import com.zy.common.utils.NavigateMapData; +import com.zy.common.utils.NavigatePositionConvert; +import com.zy.common.utils.NavigateUtils; +import com.zy.common.utils.ShuttleDispatchUtils; +import com.zy.core.Slave; +import com.zy.core.cache.MessageQueue; +import com.zy.core.cache.SlaveConnection; +import com.zy.core.enums.ShuttleRunDirection; +import com.zy.core.enums.ShuttleTaskModeType; +import com.zy.core.enums.SlaveType; +import com.zy.core.model.ShuttleSlave; +import com.zy.core.model.Task; +import com.zy.core.model.command.ShuttleAssignCommand; +import com.zy.core.model.command.ShuttleCommand; +import com.zy.core.model.protocol.NyShuttleProtocol; +import com.zy.core.model.protocol.ShuttleProtocol; import com.zy.core.properties.SlaveProperties; +import com.zy.core.thread.NyShuttleThread; +import com.zy.core.thread.ShuttleThread; import java.text.DecimalFormat; import java.util.ArrayList; @@ -329,29 +360,6 @@ return locNo; } - //妤煎眰杞崲瀵瑰簲鍑哄叆搴撶珯鐐瑰簱浣嶅彿 - public static String levToOutInStaLocNo(Integer lev) { - String locNo = null; - if (lev >= 2) { - lev++; - } - switch (lev) { - case 1: - locNo = "1800201"; - break; - case 3: - locNo = "1800202"; - break; - case 4: - locNo = "1800203"; - break; - case 5: - locNo = "1800204"; - break; - } - return locNo; - } - public static void main(String[] args) { System.out.println(JSON.toJSONString(getGroupOutsideLoc("0200101"))); } @@ -388,4 +396,140 @@ return result; } + //鑾峰彇闄ょ櫧鍚嶅崟澶栫殑鎸囧畾妤煎眰鍏ㄩ儴绌挎杞y鍧愭爣鐐� + public static List<int[]> getShuttlePoints(Integer whiteShuttle, Integer lev) { + BasShuttleService basShuttleService = SpringUtils.getBean(BasShuttleService.class); + SlaveProperties slaveProperties = SpringUtils.getBean(SlaveProperties.class); + ArrayList<int[]> list = new ArrayList<>(); + for (ShuttleSlave slave : slaveProperties.getShuttle()) { + if (slave.getId().intValue() == whiteShuttle) { + continue;//璺宠繃鐧藉悕鍗� + } + + //鑾峰彇绌挎杞︽墍鍦ㄨ妭鐐逛綅缃� + NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, slave.getId()); + if (shuttleThread == null) { + continue; + } + NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol(); + if (shuttleProtocol == null) { + continue; + } + + String currentLocNo = shuttleProtocol.getCurrentLocNo(); + + if (currentLocNo == null) { + //灏忚溅娌℃湁搴撲綅鍙锋暟鎹紝浠庢暟鎹簱涓彇 + BasShuttle basShuttle = basShuttleService.selectById(slave.getId()); + if (basShuttle == null || basShuttle.getPoint() == null) { + continue; + } + NyShuttleProtocol.NyShuttlePointClass shuttlePoint = JSON.parseObject(basShuttle.getPoint(), NyShuttleProtocol.NyShuttlePointClass.class); + currentLocNo = NavigatePositionConvert.nyXyzToLocNo(shuttlePoint.getX(), shuttlePoint.getY(), shuttlePoint.getZ()); + } + + if (lev != Utils.getLev(currentLocNo)) { + continue;//妤煎眰涓嶅悓 + } + + if (shuttleProtocol.getCurrentLocNo() == null) { + continue; + } + int[] xyPosition = NavigatePositionConvert.positionToXY(shuttleProtocol.getCurrentLocNo());//閫氳繃搴撲綅鍙疯幏鍙杧y鍧愭爣 + list.add(xyPosition); + } + return list; + } + + //鎼滅储涓�鏉℃病鏈夊皬杞︾殑绌哄贩閬擄紝骞惰皟搴﹀皬杞� + public static boolean searchEmptyGroupToMoveShuttle(int z, Integer currentShuttleId, NyShuttleThread shuttleThread) { + LocMastService locMastService = SpringUtils.getBean(LocMastService.class); + WrkMastService wrkMastService = SpringUtils.getBean(WrkMastService.class); + CommonService commonService = SpringUtils.getBean(CommonService.class); + ShuttleDispatchUtils shuttleDispatchUtils = SpringUtils.getBean(ShuttleDispatchUtils.class); + + if (shuttleThread == null) { + return false; + } + NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol(); + if (shuttleProtocol == null) { + return false; + } + + NavigateMapData mapData = new NavigateMapData(z);//鑾峰彇鍦板浘鏁版嵁 + int[][] data = mapData.getData(-1, null, currentShuttleId == null ? null : Utils.getShuttlePoints(0, z));//杞藉叆鍏ㄩ儴杞﹁締 + + int distY = -1; + int distX = -1; + int distZ = -1; + //鑾峰彇閬胯搴撲綅 + String distLocNo = null; + for (int y = 20; y <= 56; y++) { + boolean searchFlag = true; + for (int x = 10; x <= 11; x++) { + if (data[x][y] < 0 || data[x][y] == 66) { + searchFlag = false;//璇ュ贩閬撴湁绂佺敤鑺傜偣鎴栨湁灏忚溅 + break; + } + } + + if (searchFlag) { + //鎼滅储鍑虹┖宸烽亾 + distY = y; + distX = 11; + distZ = z; + + //鑾峰彇閬胯搴撲綅 + String locNo = NavigatePositionConvert.xyzToLocNo(distX, distY, distZ); + LocMast distLocMast = locMastService.queryByLoc(locNo); + if (distLocMast == null) { + continue; + } + + //鍒ゆ柇璇ュ簱浣嶆槸鍚﹀瓨鍦ㄥ伐浣滄。 + EntityWrapper<WrkMast> wrapper = new EntityWrapper<>(); + wrapper.eq("loc_no", locNo); + WrkMast wrkMast = wrkMastService.selectOne(wrapper); + if (wrkMast != null) { + continue;//瀛樺湪宸ヤ綔妗h烦杩囪搴撲綅 + } + + distLocNo = locNo; + break; + } + } + + if (distLocNo != null) { + //璋冨害灏忚溅鍒伴伩璁╀綅缃� + return shuttleDispatchUtils.dispatchShuttle(commonService.getWorkNo(7), distLocNo, shuttleProtocol.getShuttleNo().intValue()); + } + return false; + } + + //妫�娴嬫ゼ灞傛槸鍚︽湁绌挎杞� + public static boolean checkLevHasShuttle(Integer lev) { + SlaveProperties slaveProperties = SpringUtils.getBean(SlaveProperties.class); + for (ShuttleSlave shuttle : slaveProperties.getShuttle()) { + //鑾峰彇鍥涘悜绌挎杞︾嚎绋� + NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttle.getId()); + if (shuttleThread == null) { + continue; + } + NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol(); + if (shuttleProtocol == null) { + continue; + } + String currentLocNo = shuttleProtocol.getCurrentLocNo(); + if (currentLocNo == null) { + continue; + } + + if (lev == Utils.getLev(currentLocNo)) { + return true;//鎸囧畾妤煎眰鏈夌┛姊溅 + } + } + + return false;//鎸囧畾妤煎眰娌℃湁绌挎杞� + } + } -- Gitblit v1.9.1