From 1eee1c2af23940a6c2af5b519b65bdd1e7b4ac49 Mon Sep 17 00:00:00 2001
From: pang.jiabao <pang_jiabao@163.com>
Date: 星期二, 02 九月 2025 14:17:29 +0800
Subject: [PATCH] 去除多于代码,取消许可证校验

---
 src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java |  415 ++++++++++++++++++++---------------------------------------
 1 files changed, 142 insertions(+), 273 deletions(-)

diff --git a/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java b/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java
index 143e3a4..b8e30ff 100644
--- a/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java
+++ b/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java
@@ -10,8 +10,6 @@
 import com.zy.asrs.service.BasCircularShuttleService;
 import com.zy.asrs.service.BasDevpPositionService;
 import com.zy.asrs.service.WrkMastService;
-import com.zy.asrs.utils.SortTheExecutionOfTheCarUtil;
-import com.zy.asrs.utils.TimeCalculatorUtils;
 import com.zy.common.service.CommonService;
 import com.zy.core.cache.MessageQueue;
 import com.zy.core.cache.SlaveConnection;
@@ -25,16 +23,13 @@
 import com.zy.core.model.protocol.RgvProtocol;
 import com.zy.core.properties.SlaveProperties;
 import com.zy.core.thread.RgvThread;
-import com.zy.system.entity.license.LicenseVerify;
 import lombok.extern.slf4j.Slf4j;
 import org.springframework.beans.factory.annotation.Autowired;
 import org.springframework.beans.factory.annotation.Value;
 import org.springframework.stereotype.Service;
 import org.springframework.transaction.annotation.Transactional;
 
-import java.util.ArrayList;
-import java.util.Date;
-import java.util.List;
+import java.util.*;
 
 /**
  * 绔嬩綋浠撳簱WCS绯荤粺涓绘祦绋嬩笟鍔�
@@ -77,283 +72,112 @@
     @Value("${wms.reportSwitchAuto}")
     private boolean reportSwitchAuto;
 
-    /*
-    * 楠岃瘉璁稿彲璇佹槸鍚︽湁鏁�
-    * */
-    public synchronized boolean licenseVerify() {
-        try{
-//            if (true) {
-//                return true;
-//            }
-            return new LicenseVerify().verify();
-        } catch (Exception e){
-            log.info("璁稿彲璇侀獙璇佸け璐ワ紒锛佸紓甯革細{}",e.getMessage());
-        }
-        return false;
-    }
 
-
-    /**
-     * 绔欑偣浠诲姟妫�娴�  鏇存柊灏忚溅浣嶇疆淇℃伅
-     */
-    public synchronized void updateStePositionNearby() {
+    public synchronized void rgvTheHandlingTaskIsIssued() {
         try {
-            List<WrkMast> wrkMasts = wrkMastService.selectList(new EntityWrapper<WrkMast>().eq("wrk_sts", 2L));
+            List<WrkMast> wrkMasts = wrkMastService.selectList(new EntityWrapper<WrkMast>().eq("rgv_no", 0).eq("wrk_sts", 9)
+                    .orderBy("io_pri", false)
+                    .orderBy("modi_time", true));
             if (wrkMasts.isEmpty()) {
                 return;
             }
-            List<BasDevpPosition> basDevpPositions = basDevpPositionService.selectList(new EntityWrapper<BasDevpPosition>().orderBy("plc_position", true));
-            if (basDevpPositions.isEmpty()) {
-                log.error("鑾峰彇鎵�鏈夌珯鐐逛俊鎭紓甯�");
-                return;
-            }
-            List<Integer> siteList = SortTheExecutionOfTheCarUtil.WrkMastExtractSites(wrkMasts);
-            List<Integer> devpList = SortTheExecutionOfTheCarUtil.BasDevpPositionExtractSites(basDevpPositions);
-            Integer siteNo = SortTheExecutionOfTheCarUtil.ObtainDenseAreasFirstPlace(siteList, devpList);
-            if (siteNo == null) {
-                log.error("灏辫繎瀵嗛泦鍘熷垯鑾峰彇绔欑偣澶辫触");
-                return;
-            }
-            Long sitePosition = 0L;
-            for (BasDevpPosition basDevpPosition : basDevpPositions) {
-                if (basDevpPosition.getDevNo().equals(siteNo)) {
-                    sitePosition = basDevpPosition.getPlcPosition();
-                }
-            }
-            List<List<Long>> rgvPositionList = new ArrayList<>();
-            for (RgvSlave rgvSlave : slaveProperties.getRgv()) {
-                RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgvSlave.getId());
-                RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
-                if (rgvProtocol == null) {
-                    continue;
-                }
-                List<Long> rgvPosition = new ArrayList<>();
-                rgvPosition.add(rgvProtocol.getRgvNo().longValue());
-                rgvPosition.add(rgvProtocol.getRgvPos());
-                rgvPositionList.add(rgvPosition);
-            }
-            Integer rgvNo = SortTheExecutionOfTheCarUtil.LatelyAndGreaterThan(rgvPositionList, sitePosition, perimeter);
-            if (rgvNo == -1) {
-                log.info("鏇存柊灏忚溅鎺掑簭淇℃伅寮傚父={}", rgvNo);
-                return;
-            }
-            List<BasCircularShuttle> basCircularShuttleList = basCircularShuttleService.selectList(new EntityWrapper<BasCircularShuttle>().eq("status", 0).orderBy("rgv_id", true));
-            if (basCircularShuttleList.get(0).getRgvNo().equals(rgvNo)) {
-                return;
-            }
 
-            int[][] ints = new int[basCircularShuttleList.size()][2];
+            List<BasCircularShuttle> basCircularShuttleList = basCircularShuttleService.selectList(new EntityWrapper<BasCircularShuttle>().eq("status", 0));
+
+            LinkedList<RgvProtocol> rgvProtocolList = new LinkedList<>();
             for (BasCircularShuttle basCircularShuttle : basCircularShuttleList) {
-                ints[basCircularShuttle.getRgvNo() - 1] = new int[]{basCircularShuttle.getRgvNo(), basCircularShuttle.getRgvId()};
-            }
-//            String[] oldList = new String[ints.length];
-//            for (int[] rgv : ints){
-//                oldList[rgv[0]-1] = Arrays.toString(rgv);
-//            }
-            int[][] rgvList = SortTheExecutionOfTheCarUtil.ReorderSteId(ints, rgvNo);
-//            String[] newList = new String[rgvList.length];
-//            for (int[] rgv : rgvList){
-//                newList[rgv[0]-1] = Arrays.toString(rgv);
-//            }
-
-//            log.info("鏇存柊灏忚溅鎺掑簭淇℃伅锛氬師濮嬪皬杞﹀彿rgvNo={},灏忚溅閲嶆柊鎺掑簭淇℃伅={},灏忚溅鍘熷鎺掑簭淇℃伅={}",rgvNo,Arrays.toString(newList),Arrays.toString(oldList));
-            for (BasCircularShuttle basCircularShuttle : basCircularShuttleList) {
-                int[] rgv = rgvList[basCircularShuttle.getRgvNo() - 1];
-                basCircularShuttle.setRgvId(rgv[1]);
-                basCircularShuttleService.updateById(basCircularShuttle);
-            }
-
-        } catch (Exception e) {
-            log.error("鑷姩鏇存柊灏忚溅鎺掑簭淇℃伅澶辫触锛屽紓甯革細" + e);
-        }
-    }
-
-    /**
-     * 绔欑偣浠诲姟妫�娴�  鏇存柊灏忚溅浣嶇疆淇℃伅
-     */
-    public synchronized void updateStePosition() {
-        try {
-            boolean sign = false;
-            Integer rgvNo = 0;
-            List<BasCircularShuttle> basCircularShuttleList = basCircularShuttleService.selectList(new EntityWrapper<BasCircularShuttle>().orderBy("rgv_id", true));
-            for (BasCircularShuttle basCircularShuttle : basCircularShuttleList) {
-                if (basCircularShuttle.getStatus() != 0){
-                    sign = true;
-                    continue;
-                }
                 RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, basCircularShuttle.getRgvNo());
                 RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
                 if (rgvProtocol == null) {
-                    sign = true;
-                } else if (rgvProtocol.modeType != RgvModeType.AUTO || (rgvProtocol.getStatusType() != RgvStatusType.IDLE && rgvProtocol.getStatusType() != RgvStatusType.ROAM)) {
-                    sign = true;
-                } else {
-                    rgvNo = basCircularShuttle.getRgvNo();
-                    break;
+                    continue;
                 }
+                rgvProtocolList.add(rgvProtocol);
             }
-            if (sign && rgvNo != 0) {
-                int[][] ints = new int[basCircularShuttleList.size()][2];
-                for (BasCircularShuttle basCircularShuttle : basCircularShuttleList) {
-                    ints[basCircularShuttle.getRgvNo() - 1] = new int[]{basCircularShuttle.getRgvNo(), basCircularShuttle.getRgvId()};
+
+            runRgv:
+            for (WrkMast wrkMast : wrkMasts) {
+                Integer rgvSstaNo = wrkMast.getRgvSstaNo();
+                BasDevpPosition basDevpPositions = basDevpPositionService.selectOne(new EntityWrapper<BasDevpPosition>().eq("dev_no", rgvSstaNo)); // 绔欑偣
+                long position = basDevpPositions.getPlcPosition(); // 璧峰绔欎綅缃�
+                position += 50; // 灏忚溅鍙栬揣瀹氫綅绮惧害 +- 50,绔欑偣浣嶇疆10000锛屽皬杞﹀湪10050涔熸槸鍙互鍙栫殑
+                TreeMap<Long, RgvProtocol> map = new TreeMap<>();
+                for (RgvProtocol rgvProtocol : rgvProtocolList) {
+                    long distance;
+                    if (rgvProtocol.getRgvPos() <= position) {
+                        distance = position - rgvProtocol.getRgvPos();
+                    } else {
+                        distance = position + (perimeter - rgvProtocol.getRgvPos());
+                    }
+                    map.put(distance, rgvProtocol);
                 }
-//                String[] oldList = new String[ints.length];
-//                for (int[] rgv : ints){
-//                    oldList[rgv[0]-1] = Arrays.toString(rgv);
+                position -= 50;
+//                log.info("鍙栬揣绔欑偣锛歿}锛屽悗闈㈠皬杞︽帓搴�", basDevpPositions.getDevNo());
+//                StringBuilder sb = new StringBuilder();
+//                for (Map.Entry<Long, RgvProtocol> rgvProtocolMap : map.entrySet()) {
+//                    RgvProtocol rgvProtocol = rgvProtocolMap.getValue();
+//                    sb.append("[").append(rgvProtocol.getRgvNo()).append(",").append(rgvProtocol.getRgvPos()).append(",").append(rgvProtocol.getStatusType().desc).append("]");
 //                }
-                int[][] rgvList = SortTheExecutionOfTheCarUtil.ReorderSteId(ints, rgvNo);
-//                String[] newList = new String[rgvList.length];
-//                for (int[] rgv : rgvList){
-//                    newList[rgv[0]-1] = Arrays.toString(rgv);
-//                }
+//                log.info(sb.toString());
 
-//                log.info("鏇存柊灏忚溅鎺掑簭淇℃伅锛氬師濮嬪皬杞﹀彿rgvNo={},灏忚溅閲嶆柊鎺掑簭淇℃伅={},灏忚溅鍘熷鎺掑簭淇℃伅={}",rgvNo,Arrays.toString(newList),Arrays.toString(oldList));
-                for (BasCircularShuttle basCircularShuttle : basCircularShuttleList) {
-                    int[] rgv = rgvList[basCircularShuttle.getRgvNo() - 1];
-                    basCircularShuttle.setRgvId(rgv[1]);
-                    basCircularShuttleService.updateById(basCircularShuttle);
-                }
-            }
+                for (Map.Entry<Long, RgvProtocol> rgvProtocolMap : map.entrySet()) {
+                    RgvProtocol rgvProtocol = rgvProtocolMap.getValue(); // 鏈�杩戣窛绂诲皬杞�
+//                    log.info("鍙栬揣绔欑偣锛歿}锛屽悗闈㈡渶杩戝皬杞︼細{},鐘舵��:{}", basDevpPositions.getDevNo(), rgvProtocol.getRgvNo(), rgvProtocol.getStatusType().desc);
+                    int count = wrkMastService.selectCount(new EntityWrapper<WrkMast>().eq("rgv_no", rgvProtocol.getRgvNo()).eq("wrk_sts", 10));
+                        if (rgvProtocol.modeType == RgvModeType.AUTO
+                                && (rgvProtocol.getStatusType() == RgvStatusType.IDLE || rgvProtocol.getStatusType() == RgvStatusType.ROAM)
+                                && rgvProtocol.getTaskNo1() == 0
+                                && rgvProtocol.getAlarm() == 0) {
+                            if (count != 0) {
+                                log.error("{}鍛煎彨灏忚溅锛歿}鍙峰皬杞︾┖闂诧紝浣嗗伐浣滄。鏄剧ず璇ュ皬杞︽湁浠诲姟",wrkMast.getWrkNo(),rgvProtocol.getRgvNo());
+                                break ;
+                            }
+                            RgvCommand rgvCommand = new RgvCommand();
+                            rgvCommand.setRgvNo(rgvProtocol.getRgvNo());
+                            rgvCommand.setAckFinish1((short) 0);  // 宸ヤ綅1浠诲姟瀹屾垚纭浣�
+                            rgvCommand.setTaskNo1(wrkMast.getWrkNo().shortValue());
+                            rgvCommand.setTaskMode1(RgvTaskModeType.FETCH_PUT); // 宸ヤ綅1浠诲姟妯″紡:  鍙栨斁璐�
+                            rgvCommand.setSourceStaNo1(wrkMast.getRgvSstaNo().shortValue());   //宸ヤ綅1璧风偣
+                            rgvCommand.setDestinationStaNo1(wrkMast.getRgvDstaNo().shortValue());   //宸ヤ綅1鐩爣绔欑偣
+                            rgvCommand.setCommand((short) 1);   //宸ヤ綅1浠诲姟纭
+                            if (!MessageQueue.offer(SlaveType.Rgv, rgvProtocol.getRgvNo(), new Task(2, rgvCommand))) {
+                                log.error("RGV鍛戒护涓嬪彂澶辫触锛孯GV鍙�={}锛屼换鍔℃暟鎹�={}", rgvProtocol.getRgvNo(), JSON.toJSON(rgvCommand));
+                                break runRgv;
+                            }
+                            log.info("RGV鍛戒护涓嬪彂鎴愬姛锛孯GV鍙�={}锛屼换鍔℃暟鎹�={}", rgvProtocol.getRgvNo(), JSON.toJSON(rgvCommand));
+                            Date now = new Date();
+                            wrkMast.setRgvNo(rgvProtocol.getRgvNo());
+                            wrkMast.setWrkSts(10L);
+                            wrkMast.setRgvCreateTime(now);
+                            wrkMastService.updateById(wrkMast);
+                            break runRgv;
+                        } else if(rgvProtocol.modeType == RgvModeType.AUTO
+                                && rgvProtocol.getTaskNo1() != 0){ // 褰撳墠灏忚溅鏀捐揣鐩爣浣嶇疆鍦ㄥ綋鍓嶄换鍔″彇璐х偣涔嬪悗锛岃烦杩囦换鍔″垎閰嶏紝涓嶅啀鍒欏垽鏂笅涓皬杞︾洰鏍囦綅缃�
+                            WrkMast wrkMast1 = wrkMastService.selectOne(new EntityWrapper<WrkMast>().eq("wrk_no", rgvProtocol.getTaskNo1())); // 褰撳墠rgv浠诲姟
+                            if(wrkMast1!= null && !Cools.isEmpty(wrkMast1.getRgvDstaNo())) {
+                                // 褰撳墠rgv浠诲姟鐩爣绔欑偣
+                                BasDevpPosition rgvDstaNoDevPosition = basDevpPositionService.selectOne(new EntityWrapper<BasDevpPosition>().eq("dev_no", wrkMast1.getRgvDstaNo()));
+                                long rgvDstaNoPosition = rgvDstaNoDevPosition.getPlcPosition(); // 褰撳墠rgv浠诲姟鐩爣绔欑偣浣嶇疆
+                                // 鑾峰彇RGV褰撳墠浣嶇疆鍜岀姸鎬�
+                                long currentRgvPos = rgvProtocol.getRgvPos();
+                                int rgvStatus = rgvProtocol.getStatusType().id;
 
-        } catch (Exception e) {
-            log.error("鑷姩鏇存柊灏忚溅鎺掑簭淇℃伅澶辫触锛屽紓甯革細" + e);
-        }
-    }
-
-    /**
-     * 绔欑偣浠诲姟妫�娴�  涓嬪彂灏忚溅鍙栨斁浠诲姟
-     */
-    public synchronized void DevpTaskNoRun() {
-        try {
-            List<WrkMast> wrkMasts = wrkMastService.selectList(new EntityWrapper<WrkMast>().eq("rgv_no", 0).orderBy("modi_time", true));
-            if (wrkMasts.isEmpty()) {
-                return;
-            }
-            long differenceInSeconds = TimeCalculatorUtils.differenceInMilliseconds(wrkMasts.get(0).getModiTime(), new Date());
-            if (differenceInSeconds <= 100) {
-                return;
-            }
-
-            BasCircularShuttle basCircularShuttle = basCircularShuttleService.selectOne(new EntityWrapper<BasCircularShuttle>().eq("rgv_id", 1));
-            RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, basCircularShuttle.getRgvNo());
-            RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
-            if (rgvProtocol == null) {
-                return;
-            }
-            List<BasDevpPosition> basDevpPositions = basDevpPositionService.selectList(new EntityWrapper<BasDevpPosition>().orderBy("plc_position", true));
-            Integer devNo = SortTheExecutionOfTheCarUtil.LatelyAndLessThan(basDevpPositions, rgvProtocol.getRgvPos(), perimeter);
-            BasDevpPosition[] basDevpPositionsList = SortTheExecutionOfTheCarUtil.devpNoSort(basDevpPositions, devNo);
-            BasDevpPosition[] basDevpPositionsListUN = SortTheExecutionOfTheCarUtil.devpNoSortUN(basDevpPositionsList);
-            List<List<WrkMast>> wrkMastLists = getWrkMastLists(basDevpPositionsListUN);
-            //涓嬪彂浠诲姟
-            taskDown(wrkMastLists);
-        } catch (Exception e) {
-            log.error("鑷姩涓嬪彂灏忚溅鍙栨斁浠诲姟澶辫触锛屽紓甯革細" + e);
-        }
-    }
-
-    //鑾峰彇灏忚溅鍙栨斁浠诲姟鍒楄〃澶辫触
-    public synchronized List<List<WrkMast>> getWrkMastLists(BasDevpPosition[] basDevpPositionsListUN) {
-        List<List<WrkMast>> wrkMastLists = new ArrayList<>();
-        try {
-            List<WrkMast> wrkMastlistA = new ArrayList<>();
-            List<WrkMast> wrkMastlistB = new ArrayList<>();
-            for (BasDevpPosition basDevpPosition : basDevpPositionsListUN) {
-                List<WrkMast> wrkMastList = wrkMastService.selectList(new EntityWrapper<WrkMast>().eq("sta_no", basDevpPosition.getDevNo()).eq("rgv_no", 0).orderBy("modi_time", true));
-                for (WrkMast wrkMast : wrkMastList) {
-                    if (!Cools.isEmpty(wrkMast)) {
-                        if (SortTheExecutionOfTheCarUtil.devpNoSortbj(basDevpPositionsListUN, wrkMast.getSourceStaNo(), wrkMast.getStaNo())) {
-                            wrkMastlistA.add(wrkMast);
-                        } else {
-                            wrkMastlistB.add(wrkMast);
-                        }
-                    }
-                }
-            }
-            wrkMastLists.add(wrkMastlistA);
-            wrkMastLists.add(wrkMastlistB);
-            return wrkMastLists;
-        } catch (Exception e) {
-            log.error("鑾峰彇灏忚溅鍙栨斁浠诲姟鍒楄〃澶辫触锛屽紓甯革細" + e);
-            return wrkMastLists;
-        }
-    }
-
-    public synchronized void taskDown(List<List<WrkMast>> wrkMastLists) {
-        long rgvId = 0;
-        runRgv:
-        for (List<WrkMast> wrkMastList : wrkMastLists) {
-            for (WrkMast wrkMast : wrkMastList) {
-                while (rgvId <= rgvCount) {
-                    rgvId++;
-//                    log.info("瀛樺湪浠诲姟锛孯GV鍙�={}锛屼换鍔℃暟鎹�={}", rgvId, JSON.toJSON(wrkMast));
-                    if (rgvId > rgvCount) {
-                        break runRgv;
-                    }
-                    BasCircularShuttle basCircularShuttle = basCircularShuttleService.selectOne(new EntityWrapper<BasCircularShuttle>().eq("rgv_id", rgvId));
-                    if (basCircularShuttle.getStatus() != 0){
-                        continue ;
-                    }
-                    RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, basCircularShuttle.getRgvNo());
-                    RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
-                    if (rgvProtocol == null) {
-                        continue;
-                    }
-
-                    List<WrkMast> wrkMasts = wrkMastService.selectList(new EntityWrapper<WrkMast>().eq("rgv_no", rgvProtocol.getRgvNo()));
-                    if (!wrkMasts.isEmpty()) {
-                        continue;
-                    }
-                    if (rgvProtocol.modeType == RgvModeType.AUTO
-                            && (rgvProtocol.getStatusType() == RgvStatusType.IDLE || rgvProtocol.getStatusType() == RgvStatusType.ROAM)
-                            && rgvProtocol.getTaskNo1() == 0
-                            && rgvProtocol.getAlarm() == 0) {
-                        if (rgvProtocol.getStatusType() == RgvStatusType.ROAM) {
-                            double finalVelocity = 0.0;     // 鏈�缁堥�熷害 (m/s)
-                            double distance = (Math.pow(finalVelocity, 2) - Math.pow(rgvProtocol.instantaneousSpeed / 60, 2)) / (2 * acceleration);
-                            BasDevpPosition basDevpPosition = basDevpPositionService.selectOne(new EntityWrapper<BasDevpPosition>().eq("dev_no", wrkMast.getSourceStaNo()));
-                            if ((distance * proportion + (rgvProtocol.instantaneousSpeed / 60) * proportion * rgvDate) > (SortTheExecutionOfTheCarUtil.LatelyAndLessThan(basDevpPosition.getPlcPosition(), rgvProtocol.getRgvPos(), perimeter) )) {
-//                                List<BasDevpPosition> basDevpPositions = basDevpPositionService.selectList(new EntityWrapper<BasDevpPosition>().orderBy("plc_position", true));
-//                                if (basDevpPositions.isEmpty()) {
-//                                    log.error("鑾峰彇鎵�鏈夌珯鐐逛俊鎭紓甯�,RGV浠诲姟涓嬪彂澶辫触锛岃鑱旂郴绠$悊鍛橈紒锛侊紒");
-//                                    break runRgv;
-//                                }
-//                                List<Integer> devpList = SortTheExecutionOfTheCarUtil.BasDevpPositionExtractSites(basDevpPositions);
-//
-//                                if (!SortTheExecutionOfTheCarUtil.calculateShortestDistanceDirection(devpList,rgvProtocol.getEndStaM(),wrkMast.getSourceStaNo())){
-                                    continue;
-//                                }
+                                // 瀹氫箟娴姩鑼冨洿锛堜粎鍋滈潬鐘舵�侀�傜敤锛�
+                                long posTolerance = (rgvStatus == 0 || rgvStatus == 2 || rgvStatus == 3 || rgvStatus == 6 || rgvStatus == 7 || rgvStatus == 8 || rgvStatus == 100) ? 50 : 0;
+                                if(currentRgvPos < rgvDstaNoPosition + posTolerance) { // 灏忚溅褰撳墠浣嶇疆 < rgv鐩爣浣嶇疆
+                                    if(!(currentRgvPos - posTolerance < position && position < rgvDstaNoPosition + posTolerance)) { // 杩欎釜浠诲姟浣嶇疆鏄湪褰撳墠rgv浣嶇疆鍓嶉潰骞朵笖杩欎釜浠诲姟璧风偣鍦ㄥ綋鍓峳gv鐩爣绔欑偣涔嬪悗
+                                        break; // 褰撳墠rgv鏀捐揣瀹屾垚鍚庯紝鍙互鍙栧綋鍓嶄换鍔�
+                                    }
+                                } else {
+                                    if(!(currentRgvPos + posTolerance < position || position < rgvDstaNoPosition - posTolerance)) {
+                                        break;
+                                    }
+                                }
                             }
                         }
-                        RgvCommand rgvCommand = new RgvCommand();
-                        rgvCommand.setRgvNo(rgvProtocol.getRgvNo());
-                        rgvCommand.setAckFinish1((short) 0);  // 宸ヤ綅1浠诲姟瀹屾垚纭浣�
-                        rgvCommand.setTaskNo1(wrkMast.getWrkNo().shortValue());
-                        rgvCommand.setTaskMode1(RgvTaskModeType.FETCH_PUT); // 宸ヤ綅1浠诲姟妯″紡:  鍙栨斁璐�
-                        rgvCommand.setSourceStaNo1(wrkMast.getRgvSstaNo().shortValue());   //宸ヤ綅1璧风偣
-                        rgvCommand.setDestinationStaNo1(wrkMast.getRgvDstaNo().shortValue());   //宸ヤ綅1鐩爣绔欑偣
-                        rgvCommand.setCommand((short) 1);   //宸ヤ綅1浠诲姟纭
-                        if (!MessageQueue.offer(SlaveType.Rgv, rgvProtocol.getRgvNo(), new Task(2, rgvCommand))) {
-                            //
-                            log.error("RGV鍛戒护涓嬪彂澶辫触锛孯GV鍙�={}锛屼换鍔℃暟鎹�={}", rgvId, JSON.toJSON(rgvCommand));
-                            break runRgv;
-                        }
-                        log.info("RGV鍛戒护涓嬪彂鎴愬姛锛孯GV鍙�={}锛屼换鍔℃暟鎹�={}", rgvId, JSON.toJSON(rgvCommand));
-
-                        wrkMast.setRgvNo(rgvProtocol.getRgvNo());
-                        wrkMast.setAppeTime(new Date());
-                        try {
-                            wrkMastService.updateById(wrkMast);
-                            break;
-                        } catch (Exception e) {
-                            log.error("鏇存柊灏忚溅浠诲姟澶辫触,浠诲姟鍙凤細" + wrkMast.getWrkNo());
-                        }
-                        break runRgv;
-                    } else {
-                        break runRgv;
-                    }
                 }
             }
+        } catch (Exception e) {
+            log.error("鑷姩涓嬪彂灏忚溅鍙栨斁浠诲姟澶辫触锛屽紓甯革細" + e);
         }
     }
 
@@ -371,9 +195,7 @@
                     log.error("{}鍙稲GV灏氭湭鍦ㄦ暟鎹簱杩涜缁存姢锛�", rgvSlave.getId());
                     continue;
                 }
-                if (rgvProtocol.getStatusType() == RgvStatusType.WAITING) {
-                    log.info("{}鍙峰皬杞︾瓑寰厀cs纭锛岀姸鎬亄}锛屽弬鏁皗}", rgvProtocol.getRgvNo(), rgvProtocol.getStatusType(), rgvProtocol);
-                }
+
                 // 鍙湁褰揜GV绛夊緟WCS纭銆佽嚜鍔�
                 if (rgvProtocol.getStatusType() == RgvStatusType.WAITING
                         && rgvProtocol.getModeType() == RgvModeType.AUTO
@@ -381,18 +203,65 @@
                 ) {
                     log.info("{}鍙峰皬杞︾瓑寰厀cs纭锛岀姸鎬亄}锛屽弬鏁皗}",rgvProtocol.getRgvNo(),rgvProtocol.getStatusType(),rgvProtocol);
                     WrkMast wrkMast = wrkMastService.selectOne(new EntityWrapper<WrkMast>().eq("wrk_no", rgvProtocol.getTaskNo1().longValue()));
-                    if (Cools.isEmpty(wrkMast) && (wrkMast.getWrkSts() == 2 || wrkMast.getWrkSts() == 15) && (wrkMast.getRgvNo() == 0 || wrkMast.getRgvNo() > 10)) {
-                        log.error("鏈煡鍒板皬杞︽墽琛屼换鍔℃垨鑰呮墽琛屼换鍔$姸鎬佷笉绗﹀悎锛�" + rgvProtocol.getTaskNo1());
+                    if (Cools.isEmpty(wrkMast)) {
+                        log.error("鏈煡鍒板皬杞︽墽琛屼换鍔★紒" + rgvProtocol.getTaskNo1());
+                        continue;
+                    } else if(wrkMast.getWrkSts() != 10) {
+                        log.warn("鎵ц浠诲姟鐘舵�佷笉绗﹀悎锛�" + rgvProtocol.getTaskNo1());
                         continue;
                     }
                     boolean rgvComplete = rgvComplete(rgvProtocol.getRgvNo());
                     if (!rgvComplete) {
-                        log.error("灏忚溅澶嶄綅澶辫触锛屽皬杞﹀彿{}锛�", rgvProtocol.getRgvNo());
+                            log.error("灏忚溅澶嶄綅澶辫触锛屽皬杞﹀彿{}锛�", rgvProtocol.getRgvNo());
                         break;
                     }
-                    wrkMast.setRgvNo(10+rgvProtocol.getRgvNo());
+                    wrkMast.setWrkSts(2L);
+                    if (wrkMast.getIoType()==120){
+                        wrkMast.setWrkSts(53L);
+                    }
                     Date now = new Date();
-                    wrkMast.setModiTime(now);
+                    wrkMast.setRgvFinishTime(now);
+                    wrkMastService.updateById(wrkMast);
+                }
+            }
+        } catch (Exception e) {
+            log.error("灏忚溅澶嶄綅绾跨▼鎶ラ敊锛�" + e);
+        }
+    }
+
+    // 灏忚溅鍙栬揣瓒婁綅,浠诲姟鍙栨秷
+    public synchronized void rgvTaskCancel() {
+        try {
+            for (RgvSlave rgvSlave : slaveProperties.getRgv()) {
+                RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgvSlave.getId());
+                RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
+                if (rgvProtocol == null) {
+                    continue;
+                }
+
+                // 鍙湁褰揜GV绛夊緟WCS纭銆佽嚜鍔�
+                if (rgvProtocol.getStatusType() == RgvStatusType.PICK_UP_OFFSIDE
+                        && rgvProtocol.getModeType() == RgvModeType.AUTO
+                        && rgvProtocol.getTaskNo1() != 0
+                ) {
+                    WrkMast wrkMast = wrkMastService.selectOne(new EntityWrapper<WrkMast>().eq("wrk_no", rgvProtocol.getTaskNo1().longValue())
+                    .eq("rgv_no",rgvProtocol.getRgvNo()));
+                    if (Cools.isEmpty(wrkMast)) {
+                        log.error(rgvProtocol.getRgvNo() + "灏忚溅鍙栬揣瓒婁綅鏈煡鍒板皬杞︽墽琛屼换鍔★紒" + rgvProtocol.getTaskNo1());
+                        continue;
+                    } else if(wrkMast.getWrkSts() != 10) {
+                        log.warn(rgvProtocol.getRgvNo() + "灏忚溅鍙栬揣瓒婁綅鎵ц浠诲姟鐘舵�佷笉绗﹀悎锛�" + rgvProtocol.getTaskNo1());
+                        continue;
+                    }
+                    log.info("{}鍙峰皬杞﹀皬杞﹀彇璐ц秺浣嶏紝鐘舵�亄}锛屽弬鏁皗}",rgvProtocol.getRgvNo(),rgvProtocol.getStatusType(),rgvProtocol);
+                    boolean rgvComplete = rgvComplete(rgvProtocol.getRgvNo());
+                    if (!rgvComplete) {
+                        log.error("灏忚溅鍙栬揣瓒婁綅,浠诲姟鍙栨秷,澶嶄綅澶辫触锛屽皬杞﹀彿{}锛�", rgvProtocol.getRgvNo());
+                        break;
+                    }
+                    wrkMast.setWrkSts(9L);
+                    wrkMast.setRgvNo(0);
+                    wrkMast.setRgvCreateTime(new Date());
                     wrkMastService.updateById(wrkMast);
                 }
             }
@@ -408,10 +277,10 @@
         try {
             //  鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
             if (!MessageQueue.offer(SlaveType.Rgv, rgvNo, new Task(3, new RgvCommand()))) {
-                log.error("RGV鍛戒护涓嬪彂澶辫触锛孯GV鍙�={}", rgvNo);
+                log.error("灏忚溅澶嶄綅RGV鍛戒护涓嬪彂澶辫触锛孯GV鍙�={}", rgvNo);
                 return false;
             } else {
-                log.info("RGV鍛戒护涓嬪彂鎴愬姛锛孯GV鍙�={}", rgvNo);
+                log.info("灏忚溅澶嶄綅RGV鍛戒护涓嬪彂鎴愬姛锛孯GV鍙�={}", rgvNo);
                 return true;
             }
         } catch (Exception e) {

--
Gitblit v1.9.1