From ab8d3b72f79b835ea3d7e630839b1bc6e249b8a5 Mon Sep 17 00:00:00 2001
From: lsh <lsh@163.com>
Date: 星期四, 05 六月 2025 16:55:16 +0800
Subject: [PATCH] *

---
 src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java |  126 ++++++++++++++++++++++++++++++++++++++++-
 1 files changed, 121 insertions(+), 5 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 40d6c8c..73d82ce 100644
--- a/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java
+++ b/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java
@@ -11,9 +11,12 @@
 import com.zy.asrs.service.BasDevpPositionService;
 import com.zy.asrs.service.WrkMastService;
 import com.zy.asrs.task.core.ReturnT;
+import com.zy.asrs.task.escalationParam.RgvTaskReportingParam;
+import com.zy.asrs.utils.PostMesDataUtils;
 import com.zy.asrs.utils.SortTheExecutionOfTheCarUtil;
 import com.zy.asrs.utils.TimeCalculatorUtils;
 import com.zy.common.CodeRes;
+import com.zy.common.service.CommonService;
 import com.zy.common.utils.HttpHandler;
 import com.zy.core.cache.MessageQueue;
 import com.zy.core.cache.SlaveConnection;
@@ -52,6 +55,8 @@
     private BasCircularShuttleService basCircularShuttleService;
     @Autowired
     private WrkMastService wrkMastService;
+    @Autowired
+    private CommonService commonService;
 
     @Value("${constant-parameters.perimeter}")
     private Long perimeter;
@@ -63,12 +68,23 @@
     private Long rgvCount;
     @Value("${constant-parameters.rgvDate}")
     private Double rgvDate;
+    @Value("${wms.url}")
+    private String wmsUrl;
+    @Value("${wms.reportOutPath}")
+    private String wmsOutPath;
+    @Value("${wms.reportSwitch}")
+    private boolean reportSwitch;
+    @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());
@@ -102,6 +118,7 @@
             for (BasDevpPosition basDevpPosition : basDevpPositions) {
                 if (basDevpPosition.getDevNo().equals(siteNo)) {
                     sitePosition = basDevpPosition.getPlcPosition();
+                    break;
                 }
             }
             List<List<Long>> rgvPositionList = new ArrayList<>();
@@ -121,7 +138,7 @@
                 log.info("鏇存柊灏忚溅鎺掑簭淇℃伅寮傚父={}", rgvNo);
                 return;
             }
-            List<BasCircularShuttle> basCircularShuttleList = basCircularShuttleService.selectList(new EntityWrapper<BasCircularShuttle>().orderBy("rgv_id", true));
+            List<BasCircularShuttle> basCircularShuttleList = basCircularShuttleService.selectList(new EntityWrapper<BasCircularShuttle>().eq("status", 0).orderBy("rgv_id", true));
             if (basCircularShuttleList.get(0).getRgvNo().equals(rgvNo)) {
                 return;
             }
@@ -161,11 +178,15 @@
             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)) {
+                } else if (rgvProtocol.modeType != RgvModeType.AUTO || (rgvProtocol.getStatusType() != RgvStatusType.IDLE && rgvProtocol.getStatusType() != RgvStatusType.ROAM  && rgvProtocol.getStatusType() != RgvStatusType.WALK)) {
                     sign = true;
                 } else {
                     rgvNo = basCircularShuttle.getRgvNo();
@@ -271,6 +292,9 @@
                         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) {
@@ -311,6 +335,7 @@
                         rgvCommand.setSourceStaNo1(wrkMast.getSourceStaNo().shortValue());   //宸ヤ綅1璧风偣
                         rgvCommand.setDestinationStaNo1(wrkMast.getStaNo().shortValue());   //宸ヤ綅1鐩爣绔欑偣
                         rgvCommand.setCommand((short) 1);   //宸ヤ綅1浠诲姟纭
+                        rgvCommand.setRgvSome(basCircularShuttle.getRgvSome()==1 ? (short) 1 : (short) 0);
                         if (!MessageQueue.offer(SlaveType.Rgv, rgvProtocol.getRgvNo(), new Task(2, rgvCommand))) {
                             //
                             log.error("RGV鍛戒护涓嬪彂澶辫触锛孯GV鍙�={}锛屼换鍔℃暟鎹�={}", rgvId, JSON.toJSON(rgvCommand));
@@ -320,7 +345,59 @@
 
                         wrkMast.setWrkSts(2L);
                         wrkMast.setRgvNo(rgvProtocol.getRgvNo());
-                        wrkMast.setAppeTime(new Date());
+                        Date now = new Date();
+                        wrkMast.setAppeTime(now);
+                        wrkMast.setCrnStrTime(now);
+                        try {
+                            wrkMastService.updateById(wrkMast);
+                            break;
+                        } catch (Exception e) {
+                            log.error("鏇存柊灏忚溅浠诲姟澶辫触,浠诲姟鍙凤細" + wrkMast.getWrkNo());
+                        }
+                        break runRgv;
+                    } else if (rgvProtocol != null
+                            && rgvProtocol.modeType == RgvModeType.AUTO
+                            && rgvProtocol.getStatusType() == RgvStatusType.WALK
+                            && rgvProtocol.getTaskNo1() == 0
+                            && rgvProtocol.getAlarm() == 0) {
+                        if (rgvProtocol.getStatusType() == RgvStatusType.WALK) {
+                            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;
+//                                }
+                            }
+                        }
+                        RgvCommand rgvCommand = new RgvCommand();
+                        rgvCommand.setRgvNo(rgvProtocol.getRgvNo());
+                        rgvCommand.setAckFinish1((short) 0);  // 宸ヤ綅1浠诲姟瀹屾垚纭浣�
+                        rgvCommand.setTaskNo1(wrkMast.getWrkNo().shortValue());
+                        rgvCommand.setTaskMode1(RgvTaskModeType.X_MOVE); // 宸ヤ綅1浠诲姟妯″紡:  鍙栨斁璐�
+                        rgvCommand.setSourceStaNo1(wrkMast.getSourceStaNo().shortValue());   //宸ヤ綅1璧风偣
+                        rgvCommand.setDestinationStaNo1(wrkMast.getStaNo().shortValue());   //宸ヤ綅1鐩爣绔欑偣
+                        rgvCommand.setCommand((short) 1);   //宸ヤ綅1浠诲姟纭
+                        rgvCommand.setRgvSome(basCircularShuttle.getRgvSome()==1 ? (short) 1 : (short) 0);
+                        if (!MessageQueue.offer(SlaveType.Rgv, rgvProtocol.getRgvNo(), new Task(3, rgvCommand))) {
+                            //
+                            log.error("RGV鍛戒护涓嬪彂澶辫触锛孯GV鍙�={}锛屼换鍔℃暟鎹�={}", rgvId, JSON.toJSON(rgvCommand));
+                            break runRgv;
+                        }
+                        log.info("RGV鍛戒护涓嬪彂鎴愬姛锛孯GV鍙�={}锛屼换鍔℃暟鎹�={}", rgvId, JSON.toJSON(rgvCommand));
+
+                        wrkMast.setWrkSts(2L);
+                        wrkMast.setRgvNo(rgvProtocol.getRgvNo());
+                        Date now = new Date();
+                        wrkMast.setAppeTime(now);
+                        wrkMast.setCrnStrTime(now);
                         try {
                             wrkMastService.updateById(wrkMast);
                             break;
@@ -337,7 +414,7 @@
     }
 
     //浠诲姟瀹屾垚
-    public synchronized void rgvCompleteWrkMastSta() {
+    public synchronized void rgvCompleteWrkMastSta(int[] autoZ) {
         try {
             for (RgvSlave rgvSlave : slaveProperties.getRgv()) {
                 RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgvSlave.getId());
@@ -370,7 +447,46 @@
                         break;
                     }
                     wrkMast.setWrkSts(3L);
-                    wrkMast.setAppeTime(new Date());
+                    Date now = new Date();
+                    wrkMast.setAppeTime(now);
+                    wrkMast.setCrnEndTime(now);
+                    try{
+                        try{
+                            if (reportSwitch){
+                                RgvTaskReportingParam rgvTaskReportingParam = new RgvTaskReportingParam(wrkMast);
+                                ReturnT<String> result = new PostMesDataUtils().postMesDataWcs(wmsUrl, wmsOutPath, rgvTaskReportingParam);
+                                if (result.getCode()==200){
+                                    wrkMast.setWrkSts(4L);
+                                    wrkMast.setAppeTime(now);
+                                    wrkMastService.updateById(wrkMast);
+                                    continue;
+                                }else {
+                                    log.error("宸ヤ綔鍙�"+wrkMast.getWrkNo()+"浠诲姟瀹屾垚淇℃伅涓婁紶澶勭悊澶辫触");
+                                }
+                            } else {
+                                //娴嬭瘯鐢�
+                                wrkMast.setWrkSts(4L);
+                                wrkMast.setAppeTime(now);
+                                wrkMastService.updateById(wrkMast);
+                                if (reportSwitchAuto) {
+                                    WrkMast wrkMast1 = new WrkMast();
+                                    int workNo = commonService.getWorkNo(0);
+                                    wrkMast1.setWrkNo((long) workNo);
+                                    wrkMast1.setSourceStaNo(wrkMast.getSourceNoCs(autoZ));
+                                    wrkMast1.setStaNo(wrkMast.getStaNoCs(autoZ));
+                                    wrkMast1.setWrkSts(1L);
+                                    wrkMast1.setIoType(1);
+                                    wrkMast1.setModiTime(now);
+                                    wrkMast1.setAppeTime(now);
+                                    wrkMast1.setMemo("娴嬭瘯鏁版嵁");
+                                    wrkMastService.insert(wrkMast1);
+                                }
+                                continue;
+                            }
+                        } catch (Exception e){
+                            log.error("宸ヤ綔鍙�"+wrkMast.getWrkNo()+"浠诲姟瀹屾垚淇℃伅涓婁紶澶勭悊澶辫触锛屽紓甯镐俊鎭細"+e);
+                        }
+                    } catch (Exception e){}
                     wrkMastService.updateById(wrkMast);
                 }
             }

--
Gitblit v1.9.1