From 6c5963052282dfe4ae2f20d2e18012d1cff93c85 Mon Sep 17 00:00:00 2001
From: pjb <pjb123456>
Date: 星期一, 23 六月 2025 08:54:51 +0800
Subject: [PATCH] rgv调度优化

---
 src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java |  157 +++++++++++++++++++++++++++++++++++++++++++++++++++-
 1 files changed, 153 insertions(+), 4 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 86f45c2..8bcef14 100644
--- a/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java
+++ b/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java
@@ -32,9 +32,7 @@
 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绯荤粺涓绘祦绋嬩笟鍔�
@@ -358,6 +356,117 @@
         }
     }
 
+    public synchronized void rgvTheHandlingTaskIsIssued() {
+        try {
+            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;
+            }
+
+            LinkedList<RgvProtocol> rgvProtocolList = new LinkedList<>();
+            for (int i = 1; i <= 5; i++) {
+                RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, i);
+                RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
+                if (rgvProtocol == null) {
+                    continue;
+                }
+                rgvProtocolList.add(rgvProtocol);
+            }
+
+            runRgv:
+            for (WrkMast wrkMast : wrkMasts) {
+                BasDevpPosition basDevpPositions = basDevpPositionService.selectOne(new EntityWrapper<BasDevpPosition>().eq("dev_no", wrkMast.getRgvSstaNo())); // 绔欑偣
+                long position = basDevpPositions.getPlcPosition(); // 璧峰绔欎綅缃�
+                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);
+                }
+                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.getStatusType().desc).append("]");
+                }
+                log.info(sb.toString());
+
+                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(wrkMast.getIoType() == 10 || wrkMast.getIoType() == 110 || wrkMast.getSourceStaNo() == 1034) {
+                        if (count != 0) {
+                            continue;
+                        }
+                        if (rgvProtocol.modeType == RgvModeType.AUTO
+                                && (rgvProtocol.getStatusType() == RgvStatusType.IDLE || rgvProtocol.getStatusType() == RgvStatusType.ROAM)
+                                && rgvProtocol.getTaskNo1() == 0
+                                && rgvProtocol.getAlarm() == 0) {
+                            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 (count != 0) {
+                            break;
+                        }
+                        if (rgvProtocol.modeType == RgvModeType.AUTO
+                                && (rgvProtocol.getStatusType() == RgvStatusType.IDLE || rgvProtocol.getStatusType() == RgvStatusType.ROAM)
+                                && rgvProtocol.getTaskNo1() == 0
+                                && rgvProtocol.getAlarm() == 0) {
+                            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 {
+                            break ; // 鍙湅鏈�杩戠殑绗竴涓皬杞�
+                        }
+                    }
+                }
+            }
+        } catch (Exception e) {
+            log.error("鑷姩涓嬪彂灏忚溅鍙栨斁浠诲姟澶辫触锛屽紓甯革細" + e);
+        }
+    }
+
     //浠诲姟瀹屾垚
     public synchronized void rgvCompleteWrkMastSta(int[] autoZ) {
         try {
@@ -394,7 +503,47 @@
                     }
                     wrkMast.setWrkSts(2L);
                     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
+                ) {
+                    log.info("{}鍙峰皬杞﹀皬杞﹀彇璐ц秺浣嶏紝鐘舵�亄}锛屽弬鏁皗}",rgvProtocol.getRgvNo(),rgvProtocol.getStatusType(),rgvProtocol);
+                    WrkMast wrkMast = wrkMastService.selectOne(new EntityWrapper<WrkMast>().eq("wrk_no", rgvProtocol.getTaskNo1().longValue()));
+                    if (Cools.isEmpty(wrkMast)) {
+                        log.error("鏈煡鍒板皬杞︽墽琛屼换鍔★紒" + rgvProtocol.getTaskNo1());
+                        continue;
+                    } else if(wrkMast.getWrkSts() != 10) {
+                        log.error("鎵ц浠诲姟鐘舵�佷笉绗﹀悎锛�" + rgvProtocol.getTaskNo1());
+                        continue;
+                    }
+                    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);
                 }
             }

--
Gitblit v1.9.1