From ab18ecb1c25613535c2047467cf8c14d3b41b047 Mon Sep 17 00:00:00 2001
From: zjj <3272660260@qq.com>
Date: 星期二, 07 五月 2024 15:46:58 +0800
Subject: [PATCH] #空桶入库完成

---
 src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java |  936 ++++++++++++++++++++++++++++++++++++++--------------------
 1 files changed, 608 insertions(+), 328 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 40ca887..8263c0a 100644
--- a/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java
+++ b/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java
@@ -24,6 +24,7 @@
 import com.zy.common.utils.News;
 import com.zy.core.CrnThread;
 import com.zy.core.DevpThread;
+import com.zy.core.RgvThread;
 import com.zy.core.cache.MessageQueue;
 import com.zy.core.cache.SlaveConnection;
 import com.zy.core.enums.*;
@@ -46,6 +47,7 @@
 import org.springframework.transaction.annotation.Transactional;
 import org.springframework.transaction.interceptor.TransactionAspectSupport;
 
+import java.io.IOException;
 import java.util.*;
 import java.util.stream.Collectors;
 
@@ -86,9 +88,13 @@
     private BasErrLogService basErrLogService;
     @Autowired
     private BasCrnErrorMapper basCrnErrorMapper;
+    @Autowired
+    private EmptyBarrelInService emptyBarrelInService;
 
     @Value("${wms.url}")
     private String wmsUrl;
+
+    public int workNo = 9900;
 
     /**
      * 缁勬墭
@@ -106,6 +112,57 @@
                 }
                 String barcode = barcodeThread.getBarcode();
 
+
+
+                // 鑾峰彇鍏ュ簱绔欎俊鎭�
+                SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, devp.getId());
+                StaProtocol staProtocol = devpThread.getStation().get(inSta.getStaNo());
+                if (staProtocol == null) {
+                    continue;
+                } else {
+                    staProtocol = staProtocol.clone();
+                }
+                // 灏哄妫�娴嬪紓甯�
+                boolean back = false;
+                String errMsg = "寮傚父锛�";
+                if (staProtocol.isFrontErr()) {
+                    errMsg = errMsg+"鍓嶈秴闄愶紱";
+                    back = true;
+                }
+                if (staProtocol.isBackErr()) {
+                    errMsg = errMsg+"鍚庤秴闄�";
+                    back = true;
+                }
+                if (staProtocol.isHighErr()) {
+                    errMsg = errMsg+"楂樿秴闄�";
+                    back = true;
+                }
+                if (staProtocol.isLeftErr()) {
+                    errMsg = errMsg+"宸﹁秴闄�";
+                    back = true;
+                }
+                if (staProtocol.isRightErr()) {
+                    errMsg = errMsg+"鍙宠秴闄�";
+                    back = true;
+                }
+                if (staProtocol.isWeightErr()) {
+                    errMsg = errMsg+"瓒呴噸";
+                    back = true;
+                }
+                if (staProtocol.isBarcodeErr()) {
+                    errMsg = errMsg+"鎵爜澶辫触";
+                    back = true;
+                }
+                // 閫�鍥�
+                if (back) {
+                    // led 寮傚父鏄剧ず
+                    LedThread ledThread = (LedThread) SlaveConnection.get(SlaveType.Led, inSta.getLed());
+                    if (ledThread != null) {
+                        MessageQueue.offer(SlaveType.Led, inSta.getLed(), new Task(3, errMsg));
+                    }
+                    continue;
+                }
+
                 if (!Cools.isEmpty(barcode)) {
                     log.info("{}鍙锋潯鐮佹壂鎻忓櫒妫�娴嬫潯鐮佷俊鎭細{}", inSta.getBarcode(), barcode);
                     if ("NG".endsWith(barcode) || "NoRead".equals(barcode)) {
@@ -120,16 +177,6 @@
 //                    }
                     continue;
                 }
-
-                // 鑾峰彇鍏ュ簱绔欎俊鎭�
-                SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, devp.getId());
-                StaProtocol staProtocol = devpThread.getStation().get(inSta.getStaNo());
-                if (staProtocol == null) {
-                    continue;
-                } else {
-                    staProtocol = staProtocol.clone();
-                }
-
                 // 鍒ゆ柇鏄惁婊¤冻鍏ュ簱鏉′欢
                 if (staProtocol.isAutoing()
                         && staProtocol.isLoading()
@@ -179,7 +226,6 @@
                         param.setIoType(1);
                         param.setSourceStaNo(inSta.getStaNo());
                         param.setLocType1(locTypeDto.getLocType1());
-                        param.setFull(staProtocol.isFull());
                         String response = new HttpHandler.Builder()
                                 .setUri(wmsUrl)
                                 .setPath("/rpc/pakin/loc/v1")
@@ -211,6 +257,12 @@
 //                                MessageQueue.offer(SlaveType.Led, inSta.getLed(), new Task(3, errorMsg));
 //                            }
                             log.error(barcode + "鎵樼洏璇嗗埆寮傚父锛岃鍏堣繘琛岀粍鎵橈紒");
+                            // led 寮傚父鏄剧ず
+                            ledThread = (LedThread) SlaveConnection.get(SlaveType.Led, inSta.getLed());
+                            if (ledThread != null) {
+                                String errorMsg = barcode + "鎵樼洏璇嗗埆寮傚父锛岃鍏堣繘琛岀粍鎵橈紒";
+                                MessageQueue.offer(SlaveType.Led, inSta.getLed(), new Task(3, errorMsg));
+                            }
                         } else {
                             log.error("璇锋眰鎺ュ彛澶辫触锛侊紒锛乽rl锛歿}锛況equest锛歿}锛況esponse锛歿}", wmsUrl + "/rpc/pakin/loc/v1", JSON.toJSONString(param), response);
                         }
@@ -323,7 +375,7 @@
                         && staProtocol.isLoading()
                         && staProtocol.isInEnable()
                         && staProtocol.isPakMk()
-                        && staProtocol.getWorkNo() == 9991) {
+                        && staProtocol.getWorkNo() == 9999) {
 //                    WrkMast wrkMast = wrkMastMapper.selectPickStep(barcode);
                     LedThread ledThread = (LedThread) SlaveConnection.get(SlaveType.Led, pickSta.getLed());
                     if (barcode.equals("") || barcode.equals("99999999")) {
@@ -343,8 +395,9 @@
                         continue;
                     }
 
-                    WrkMast wrkMast = wrkMastMapper.selectPakInStep3(staProtocol.getWorkNo().intValue());
-                    ledThread.errorReset();
+//                    WrkMast wrkMast = wrkMastMapper.selectPakInStep3(staProtocol.getWorkNo().intValue());
+                    WrkMast wrkMast = wrkMastService.selectOne(new EntityWrapper<WrkMast>().eq("barcode", barcode));
+
                     if (wrkMast == null) {
                         wrkMast = wrkMastMapper.selectPickStep(barcode);
                     }
@@ -428,6 +481,8 @@
                     boolean result = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
                     if (!result) {
                         log.error("鍙戝竷鍛戒护鑷宠緭閫佺嚎闃熷垪澶辫触锛侊紒锛� [plc缂栧彿锛歿}]", devp.getId());
+                    }else {
+                        ledThread.errorReset();
                     }
 
                 }
@@ -442,6 +497,9 @@
      */
     public synchronized void crnStnToOutStn() {
         for (CrnSlave crnSlave : slaveProperties.getCrn()) {
+            if (crnSlave.getId() ==5){
+                continue;
+            }
             // 閬嶅巻鍫嗗灈鏈哄嚭搴撶珯
             for (CrnSlave.CrnStn crnStn : crnSlave.getCrnOutStn()) {
                 // 鑾峰彇鍫嗗灈鏈哄嚭搴撶珯淇℃伅
@@ -475,13 +533,15 @@
                             && crnProtocol.forkPosType == CrnForkPosType.HOME) {
 
                         // 鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
-
-                        // 涓嬪彂绔欑偣淇℃伅
-                        staProtocol.setWorkNo(wrkMast.getWrkNo().shortValue());
-                        staProtocol.setStaNo(wrkMast.getStaNo().shortValue());
-                        if (!MessageQueue.offer(SlaveType.Devp, crnStn.getDevpPlcId(), new Task(2, staProtocol))) {
-                            continue;
+                        if (crnProtocol.getCrnNo() !=5){
+                            // 涓嬪彂绔欑偣淇℃伅
+                            staProtocol.setWorkNo(wrkMast.getWrkNo().shortValue());
+                            staProtocol.setStaNo(wrkMast.getStaNo().shortValue());
+                            if (!MessageQueue.offer(SlaveType.Devp, crnStn.getDevpPlcId(), new Task(2, staProtocol))) {
+                                continue;
+                            }
                         }
+
 
                         if (crnStn.getStaNo() == 1016 || crnStn.getStaNo() == 1019) {
                             // 鏇存柊宸ヤ綔妗g姸鎬佷负13.RGV鎼繍涓�
@@ -510,6 +570,9 @@
      */
     public synchronized void crnIoExecute() {
         for (CrnSlave crn : slaveProperties.getCrn()) {
+            if (crn.getId() == 5){
+                continue;
+            }
             // 鑾峰彇鍫嗗灈鏈轰俊鎭�
             CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn, crn.getId());
             CrnProtocol crnProtocol = crnThread.getCrnProtocol();
@@ -533,6 +596,9 @@
                 // 濡傛灉鏈�杩戜竴娆℃槸鍏ュ簱妯″紡
                 if (crnProtocol.getLastIo().equals("I")) {
                     if (basCrnp.getInEnable().equals("Y")) {
+                        if (crn.getId() == 5){
+                            continue;
+                        }
                         this.crnStnToLoc(crn, crnProtocol); //  鍏ュ簱
                         crnProtocol.setLastIo("O");
                     } else if (basCrnp.getOutEnable().equals("Y")) {
@@ -546,6 +612,10 @@
                         this.locToCrnStn(crn, crnProtocol); //  鍑哄簱
                         crnProtocol.setLastIo("I");
                     } else if (basCrnp.getInEnable().equals("Y")) {
+                        if (crn.getId() == 5){
+                            continue;
+                        }
+
                         this.crnStnToLoc(crn, crnProtocol); //  鍏ュ簱
                         crnProtocol.setLastIo("O");
                     }
@@ -811,7 +881,7 @@
                         LocMast shallowLoc = locMastService.selectById(shallowLocNo);
                         // O.绌哄簱浣嶃�丵.鎷f枡/鐩樼偣/骞舵澘鍐嶅叆搴撱�丼.鍏ュ簱棰勭害銆乆.绂佺敤 鐩存帴鎼紒
                         if (shallowLoc.getLocSts().equals("P") || shallowLoc.getLocSts().equals("R")) {
-                            WrkMast waitWrkMast = wrkMastMapper.selectByLocNo(shallowLocNo);
+                            WrkMast waitWrkMast = wrkMastMapper.selectByLocNo1(shallowLocNo);
                             if (null == waitWrkMast) {
                                 log.error("{}搴撲綅寮傚父锛屾湭妫�绱㈠埌鐩稿簲宸ヤ綔妗o紒", shallowLocNo);
                             } else {
@@ -842,7 +912,7 @@
                             log.error("{}浠诲姟鍑哄簱澶辫触锛屾祬搴撲綅鍫靛锛佹祬搴撲綅鍙�:{}", wrkMast.getWrkNo(), shallowLocNo);
                             continue;
                         } else if (shallowLoc.getLocSts().equals("Q") || shallowLoc.getLocSts().equals("S")) {
-                            WrkMast waitWrkMast = wrkMastMapper.selectByLocNo(shallowLocNo);
+                            WrkMast waitWrkMast = wrkMastMapper.selectByLocNo1(shallowLocNo);
                             if (null != waitWrkMast && (waitWrkMast.getWrkSts() == 4 || waitWrkMast.getWrkSts() == 5)) {
                                 continue;
                             }
@@ -1247,6 +1317,7 @@
                 // 鑾峰彇绌烘澘鍏ュ簱绔欎俊鎭�
                 SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, devp.getId());
                 StaProtocol staProtocol = devpThread.getStation().get(emptyInSta.getStaNo());
+                LedThread ledThread = (LedThread) SlaveConnection.get(SlaveType.Led, emptyInSta.getLed());
                 if (staProtocol == null) {
                     continue;
                 } else {
@@ -1257,6 +1328,13 @@
                 if (staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.isInEnable()
                         && staProtocol.isEmptyMk() && (staProtocol.getWorkNo() >= 9990
                         && staProtocol.getWorkNo() <= 9999) && staProtocol.isPakMk()) {
+                    List<WrkMast> wrkMasts = wrkMastService.selectList(new EntityWrapper<WrkMast>()
+                            .eq("sta_no", emptyInSta.getStaNo())
+                            .eq("io_type", 10)
+                            .eq("wrk_sts", 2));
+                    if (!Cools.isEmpty(wrkMasts)){
+                        continue;
+                    }
                     try {
                         LocTypeDto locTypeDto = new LocTypeDto(staProtocol);
 
@@ -1273,7 +1351,7 @@
                         JSONObject jsonObject = JSON.parseObject(response);
                         if (jsonObject.getInteger("code").equals(200)) {
                             StartupDto dto = jsonObject.getObject("data", StartupDto.class);
-
+                            ledThread.errorReset();
                             // 鏇存柊绔欑偣淇℃伅 涓� 涓嬪彂plc鍛戒护
                             staProtocol.setWorkNo(dto.getWorkNo().shortValue());
                             staProtocol.setStaNo(dto.getStaNo().shortValue());
@@ -1414,7 +1492,7 @@
                 // 鑾峰彇鍙夎溅绔欑偣
                 StaProtocol staProtocol = devpThread.getStation().get(staNo);
                 if (staProtocol == null) { continue; }
-                if (staProtocol.getWorkNo() != 0) {
+                if (staProtocol.getWorkNo() != 0 || staProtocol.isErr()) {
                     reset = false;
                     break;
                 }
@@ -1955,272 +2033,21 @@
 
     }
 
-    //RGV鎼繍
-    public synchronized void rgvIoExecute() {
-        for (RgvSlave slave : slaveProperties.getRgv()) {
-            ZyRgvThread rgvThread = (ZyRgvThread) SlaveConnection.get(SlaveType.Rgv, slave.getId());
-            if (rgvThread == null) {
-                return;
-            }
 
-            RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
-            if (rgvProtocol == null) {
-                return;
-            }
 
-            // 鍒ゆ柇RGV鏄惁绌洪棽
-            if (rgvProtocol.getModeType() == RgvModeType.COMPUTER
-                    && rgvProtocol.getStatusType() == RgvStatusType.IDLE) {
-                // 濡傛灉鏈�杩戜竴娆℃槸鍏ュ簱妯″紡锛屽垯浼樺厛鎵弿鍑哄簱绔欑偣
-                if (rgvProtocol.getLastIo().equals("I")) {
-                    this.rgvOutExecute(rgvThread, rgvProtocol);//鍑哄簱
-                    rgvProtocol.setLastIo("O");
-                }else {
-                    this.rgvInExecute(rgvThread, rgvProtocol);//鍏ュ簱
-                    rgvProtocol.setLastIo("I");
-                }
 
-                //妫�鏌ユ槸鍚﹀瓨鍦ㄥ伐浣�1浠诲姟瓒呮椂娌′笅鍙�
-                if (rgvProtocol.getTaskNo1() > 0 && rgvProtocol.getTaskNo2() == 0) {
-                    if (System.currentTimeMillis() - rgvProtocol.getTask1SendTime() > (1000*60)) {
-                        //宸ヤ綅1涓嬪彂鏃堕棿瓒呰繃60s
-                        RgvCommand rgvCommand = new RgvCommand();
-                        rgvCommand.setRgvNo(rgvProtocol.getRgvNo());//RGV缂栧彿
-                        rgvCommand.setCommand((short) 1);//宸ヤ綅1纭
-                        if (!MessageQueue.offer(SlaveType.Rgv, rgvCommand.getRgvNo(), new Task(4, rgvCommand))) {
-                            log.error("RGV纭鍛戒护涓嬪彂澶辫触锛孯GV鍙�={}锛屼换鍔℃暟鎹�={}", rgvProtocol.getRgvNo(), JSON.toJSON(rgvCommand));
-                            return;
-                        }
-                        log.error("RGV纭鍛戒护涓嬪彂鎴愬姛锛孯GV鍙�={}锛屼换鍔℃暟鎹�={}", rgvProtocol.getRgvNo(), JSON.toJSON(rgvCommand));
-                    }
-                }
-            }
-        }
-    }
 
-    //rgv鍏ュ簱
-    public synchronized void rgvInExecute(ZyRgvThread rgvThread, RgvProtocol rgvProtocol) {
-        for (RgvSlave.Sta sta : rgvThread.getSlave().getInStn()) {
-            if (rgvProtocol.getTaskNo1() > 0) {
-                //妫�娴媟gv宸ヤ綅1鏄惁涓哄叆搴撲换鍔�
-                WrkMast wrkMast1 = wrkMastMapper.selectByWrkNo(rgvProtocol.getTaskNo1().intValue());
-                if (wrkMast1.getWrkSts() > 100) {
-                    continue;//鍑哄簱浠诲姟璺宠繃
-                }
-            }
 
-            SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, sta.getDevpPlcId());
-            StaProtocol staProtocol = devpThread.getStation().get(sta.getSourceStaNo());
-            //鍒ゆ柇杈撻�佺嚎鏄惁鑷姩銆佹湁鐗┿�佸彲鍏ャ�佹湁宸ヤ綔鍙�
-            if (!(staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.isOutEnable() && (staProtocol.getWorkNo() > 0))) {
-                continue;
-            }
-
-            //鎼滅储宸ヤ綔妗�
-            WrkMast wrkMast = wrkMastMapper.selectByWrkNo(staProtocol.getWorkNo().intValue());
-            if (wrkMast == null) {
-                continue;//宸ヤ綔妗d笉瀛樺湪
-            }
-
-            //鑾峰彇RGV鏀捐揣绔欑偣
-            Integer staNo = Utils.getRgvStaNo(rgvProtocol.getRgvNo(), sta.getSourceStaNo(), staProtocol.getStaNo().intValue(), true);
-            if (staNo == null) {
-                continue;//RGV鏀捐揣绔欑偣涓嶅瓨鍦�
-            }
-
-            //鍒ゆ柇鐩爣绔欐槸鍚﹁嚜鍔ㄣ�佸彲鍏ャ�佹棤鐗┿�佹棤宸ヤ綔鍙�
-            StaProtocol staProtocol1 = devpThread.getStation().get(staNo);
-            if (!(staProtocol1.isAutoing() && staProtocol1.isInEnable() && !staProtocol1.isLoading() && (staProtocol1.getWorkNo() == 0))) {
-                continue;
-            }
-
-            // 鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
-            RgvCommand rgvCommand = new RgvCommand();
-            rgvCommand.setRgvNo(rgvProtocol.getRgvNo());//RGV缂栧彿
-            rgvCommand.setAckFinish((short) 0);
-
-            //鍒ゆ柇rgv宸ヤ綅1鏄惁鍙敤
-            if (rgvProtocol.getTaskNo1() == 0) {
-                rgvCommand.setTaskNo1(wrkMast.getWrkNo().shortValue());//宸ヤ綔鍙�
-                rgvCommand.setTaskMode1(RgvTaskModeType.PICK_RELEASE);//宸ヤ綔妯″紡 鍙栨斁璐�
-                rgvCommand.setSourceStaNo1(staProtocol.getStaNo());//婧愮珯
-                rgvCommand.setDestinationStaNo1(staNo.shortValue());//鐩爣绔�
-                rgvCommand.setCommand((short) 0);//宸ヤ綅1鏆備笉纭
-            } else if (rgvProtocol.getTaskNo2() == 0) {//鍒ゆ柇rgv宸ヤ綅2鏄惁鍙敤
-                rgvCommand.setTaskNo2(wrkMast.getWrkNo().shortValue());//宸ヤ綔鍙�
-                rgvCommand.setTaskMode2(RgvTaskModeType.PICK_RELEASE);//宸ヤ綔妯″紡 鍙栨斁璐�
-                rgvCommand.setSourceStaNo2(staProtocol.getStaNo());//婧愮珯
-                rgvCommand.setDestinationStaNo2(staNo.shortValue());//鐩爣绔�
-                rgvCommand.setCommand((short) 1);//宸ヤ綅2纭
-            }else {
-                continue;//娌℃湁鍙敤RGV宸ヤ綅
-            }
-
-            if (!MessageQueue.offer(SlaveType.Rgv, rgvCommand.getRgvNo(), new Task(2, rgvCommand))) {
-                log.error("RGV鍛戒护涓嬪彂澶辫触锛孯GV鍙�={}锛屼换鍔℃暟鎹�={}", rgvProtocol.getRgvNo(), JSON.toJSON(rgvCommand));
-                continue;
-            }
-
-            log.error("RGV鍛戒护涓嬪彂鎴愬姛锛孯GV鍙�={}锛屼换鍔℃暟鎹�={}", rgvProtocol.getRgvNo(), JSON.toJSON(rgvCommand));
-        }
-    }
-
-    //rgv鍑哄簱
-    public synchronized void rgvOutExecute(ZyRgvThread rgvThread, RgvProtocol rgvProtocol) {
-        for (RgvSlave.Sta sta : rgvThread.getSlave().getOutStn()) {
-            if (rgvProtocol.getTaskNo1() > 0) {
-                //妫�娴媟gv宸ヤ綅1鏄惁涓哄嚭搴撲换鍔�
-                WrkMast wrkMast1 = wrkMastMapper.selectByWrkNo(rgvProtocol.getTaskNo1().intValue());
-                if (wrkMast1.getWrkSts() < 100) {
-                    continue;//鍏ュ簱浠诲姟璺宠繃
-                }
-            }
-
-            SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, sta.getDevpPlcId());
-            StaProtocol staProtocol = devpThread.getStation().get(sta.getSourceStaNo());
-            //鍒ゆ柇杈撻�佺嚎鏄惁鑷姩銆佹湁鐗┿�佸彲鍑恒�佹湁宸ヤ綔鍙�
-            if (!(staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.isOutEnable() && (staProtocol.getWorkNo() > 0))) {
-                continue;
-            }
-
-            //鎼滅储宸ヤ綔妗�
-            WrkMast wrkMast = wrkMastMapper.selectByWrkNo(staProtocol.getWorkNo().intValue());
-            if (wrkMast == null) {
-                continue;//宸ヤ綔妗d笉瀛樺湪
-            }
-
-            //鑾峰彇RGV鏀捐揣绔欑偣
-            Integer staNo = Utils.getRgvStaNo(rgvProtocol.getRgvNo(), sta.getSourceStaNo(), staProtocol.getStaNo().intValue(), false);
-            if (staNo == null) {
-                continue;//RGV鏀捐揣绔欑偣涓嶅瓨鍦�
-            }
-
-            //鍒ゆ柇鐩爣绔欐槸鍚﹁嚜鍔ㄣ�佸彲鍑恒�佹棤鐗┿�佹棤宸ヤ綔鍙�
-            StaProtocol staProtocol1 = devpThread.getStation().get(staNo);
-            if (!(staProtocol1.isAutoing() && staProtocol1.isOutEnable() && !staProtocol1.isLoading() && (staProtocol1.getWorkNo() == 0))) {
-                continue;
-            }
-
-            // 鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
-            RgvCommand rgvCommand = new RgvCommand();
-            rgvCommand.setRgvNo(rgvProtocol.getRgvNo());//RGV缂栧彿
-            rgvCommand.setAckFinish((short) 0);
-
-            //鍒ゆ柇rgv宸ヤ綅1鏄惁鍙敤
-            if (rgvProtocol.getTaskNo1() == 0) {
-                rgvCommand.setTaskNo1(wrkMast.getWrkNo().shortValue());//宸ヤ綔鍙�
-                rgvCommand.setTaskMode1(RgvTaskModeType.PICK_RELEASE);//宸ヤ綔妯″紡 鍙栨斁璐�
-                rgvCommand.setSourceStaNo1(staProtocol.getStaNo());//婧愮珯
-                rgvCommand.setDestinationStaNo1(staNo.shortValue());//鐩爣绔�
-                rgvCommand.setCommand((short) 0);//宸ヤ綅1鏆備笉纭
-            } else if (rgvProtocol.getTaskNo2() == 0) {//鍒ゆ柇rgv宸ヤ綅2鏄惁鍙敤
-                rgvCommand.setTaskNo2(wrkMast.getWrkNo().shortValue());//宸ヤ綔鍙�
-                rgvCommand.setTaskMode2(RgvTaskModeType.PICK_RELEASE);//宸ヤ綔妯″紡 鍙栨斁璐�
-                rgvCommand.setSourceStaNo2(staProtocol.getStaNo());//婧愮珯
-                rgvCommand.setDestinationStaNo2(staNo.shortValue());//鐩爣绔�
-                rgvCommand.setCommand((short) 1);//宸ヤ綅2纭
-            }else {
-                continue;//娌℃湁鍙敤RGV宸ヤ綅
-            }
-
-            if (!MessageQueue.offer(SlaveType.Rgv, rgvCommand.getRgvNo(), new Task(2, rgvCommand))) {
-                log.error("RGV鍛戒护涓嬪彂澶辫触锛孯GV鍙�={}锛屼换鍔℃暟鎹�={}", rgvProtocol.getRgvNo(), JSON.toJSON(rgvCommand));
-                continue;
-            }
-
-            log.error("RGV鍛戒护涓嬪彂鎴愬姛锛孯GV鍙�={}锛屼换鍔℃暟鎹�={}", rgvProtocol.getRgvNo(), JSON.toJSON(rgvCommand));
-        }
-    }
-
-    //RGV宸ヤ綔瀹屾垚
-    public synchronized void rgvFinished() {
-        SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, 1);
-        for (RgvSlave slave : slaveProperties.getRgv()) {
-            ZyRgvThread rgvThread = (ZyRgvThread) SlaveConnection.get(SlaveType.Rgv, slave.getId());
-            if (rgvThread == null) {
-                return;
-            }
-
-            RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
-            if (rgvProtocol == null) {
-                return;
-            }
-
-            //  鐘舵�侊細绛夊緟纭
-            if (rgvProtocol.getStatusType() == RgvStatusType.WAITING) {
-                if (rgvProtocol.getTaskNo1() == 9999) {
-                    // RGV澶嶄綅
-                    rgvThread.setResetFlag1(true);
-                }else {
-                    // 鑾峰彇寰呯‘璁ゅ伐浣滄。
-                    WrkMast wrkMast = wrkMastMapper.selectPakInStep3(rgvProtocol.getTaskNo1().intValue());
-                    if (wrkMast == null) {
-                        log.error("RGV澶勪簬绛夊緟纭涓斾换鍔″畬鎴愮姸鎬侊紝浣嗘湭鎵惧埌宸ヤ綔妗c�俁GV鍙�={}锛屽伐浣滃彿={}", rgvProtocol.getRgvNo(), rgvProtocol.getTaskNo1());
-                        continue;
-                    }
-
-                    if (rgvProtocol.getTaskNo1() > 0 && rgvProtocol.getTaskFinish1() == 1) {
-                        //宸ヤ綅1浠诲姟瀹屾垚
-                        // RGV澶嶄綅
-                        rgvThread.setResetFlag1(true);
-
-                        //缁欑洰鏍囩珯杈撻�佺嚎鍐欏叆鏁版嵁
-                        Short destinationPos1 = rgvProtocol.getDestinationPos1();//鑾峰彇宸ヤ綅1鐩爣绔�
-                        StaProtocol staProtocol = devpThread.getStation().get(destinationPos1.intValue()).clone();
-                        staProtocol.setWorkNo(wrkMast.getWrkNo().shortValue());//鍐欏叆宸ヤ綔鍙�
-                        staProtocol.setStaNo(wrkMast.getStaNo().shortValue());//鍐欏叆鐩爣绔�
-                        if (!MessageQueue.offer(SlaveType.Devp, 1, new Task(2, staProtocol))) {
-                            log.info("{}浠诲姟锛孯GV鎼繍鎴愬姛锛屽啓鍏ヨ緭閫佹暟鎹け璐}", wrkMast.getWrkNo(), JSON.toJSONString(staProtocol));
-                        }
-
-                        //2鍙稲GV鍜�3鍙稲GV宸ヤ綔瀹屾垚鍚庨渶瑕佹洿鏂板伐浣滄。鐘舵��
-                        if (rgvProtocol.getRgvNo() == 2 || rgvProtocol.getRgvNo() == 3) {
-                            if (wrkMast.getWrkSts() == 13) {//13.RGV鎼繍涓� => 14.宸插嚭搴�
-                                wrkMast.setWrkSts(14L);
-                                wrkMast.setModiTime(new Date());
-                                wrkMastMapper.updateById(wrkMast);
-                            }
-                        }
-                    }
-
-                    if (rgvProtocol.getTaskNo2() > 0 && rgvProtocol.getTaskFinish2() == 1) {
-                        //宸ヤ綅2浠诲姟瀹屾垚
-                        // RGV澶嶄綅
-                        rgvThread.setResetFlag2(true);
-
-                        //缁欑洰鏍囩珯杈撻�佺嚎鍐欏叆鏁版嵁
-                        Short destinationPos2 = rgvProtocol.getDestinationPos2();//鑾峰彇宸ヤ綅2鐩爣绔�
-                        StaProtocol staProtocol = devpThread.getStation().get(destinationPos2.intValue()).clone();
-                        staProtocol.setWorkNo(wrkMast.getWrkNo().shortValue());//鍐欏叆宸ヤ綔鍙�
-                        staProtocol.setStaNo(wrkMast.getStaNo().shortValue());//鍐欏叆鐩爣绔�
-                        if (!MessageQueue.offer(SlaveType.Devp, 1, new Task(2, staProtocol))) {
-                            log.info("{}浠诲姟锛孯GV鎼繍鎴愬姛锛屽啓鍏ヨ緭閫佹暟鎹け璐}", wrkMast.getWrkNo(), JSON.toJSONString(staProtocol));
-                        }
-
-                        //2鍙稲GV鍜�3鍙稲GV宸ヤ綔瀹屾垚鍚庨渶瑕佹洿鏂板伐浣滄。鐘舵��
-                        if (rgvProtocol.getRgvNo() == 2 || rgvProtocol.getRgvNo() == 3) {
-                            if (wrkMast.getWrkSts() == 13) {//13.RGV鎼繍涓� => 14.宸插嚭搴�
-                                wrkMast.setWrkSts(14L);
-                                wrkMast.setModiTime(new Date());
-                                wrkMastMapper.updateById(wrkMast);
-                            }
-                        }
-                    }
-                }
-            }
-        }
-    }
 
     /**
      * 鎵弿纰熺洏鏈鸿嚜鍔ㄥ叆搴撶┖鎵樼洏
      */
     public synchronized void autoEmptyIn() {
-        for (CrnSlave crnSlave : slaveProperties.getCrn()) {
-            // 閬嶅巻绌烘澘鍏ュ簱鍙�
-            for (CrnSlave.CrnStn emptyInStn : crnSlave.getEmptyCrnInStn()) {
+        for (DevpSlave slave : slaveProperties.getDevp()) {
+            for (DevpSlave.Sta sta : slave.getAutoEmptyIn()) {
                 // 鑾峰彇绌烘澘鍏ュ簱绔欎俊鎭�
-                SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, emptyInStn.getDevpPlcId());
-                StaProtocol staProtocol = devpThread.getStation().get(emptyInStn.getStaNo());
+                SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, slave.getId());
+                StaProtocol staProtocol = devpThread.getStation().get(sta.getStaNo());
                 if (staProtocol == null) {
                     continue;
                 } else {
@@ -2229,41 +2056,66 @@
 
                 // 绔欑偣鏉′欢鍒ゆ柇
                 if (staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.isInEnable()
-                        && staProtocol.isEmptyMk() && (staProtocol.getWorkNo() >= 9990
-                        && staProtocol.getWorkNo() <= 9999)) {
-                    try {
-                        LocTypeDto locTypeDto = new LocTypeDto(staProtocol);
+                        && staProtocol.isEmptyInPalletRequire() && staProtocol.getWorkNo() == 0) {
+                    List<StaDesc> staDescs = staDescService.selectList(new EntityWrapper<StaDesc>().eq("type_no", 10).eq("stn_no", sta.getStaNo()));
+                    for (StaDesc staDesc:staDescs){
 
-                        SearchLocParam param = new SearchLocParam();
-                        param.setIoType(10);
-                        param.setSourceStaNo(emptyInStn.getStaNo());
-                        param.setLocType1(locTypeDto.getLocType1());
-                        String response = new HttpHandler.Builder()
-                                .setUri(wmsUrl)
-                                .setPath("/rpc/pakin/loc/v1")
-                                .setJson(JSON.toJSONString(param))
-                                .build()
-                                .doPost();
-                        JSONObject jsonObject = JSON.parseObject(response);
-                        if (jsonObject.getInteger("code").equals(200)) {
-                            StartupDto dto = jsonObject.getObject("data", StartupDto.class);
+                        BasDevp basDevp = basDevpService.selectOne(new EntityWrapper<BasDevp>().eq("dev_no", staDesc.getCrnStn()));
 
-                            // 鏇存柊绔欑偣淇℃伅 涓� 涓嬪彂plc鍛戒护
-                            staProtocol.setWorkNo(dto.getWorkNo().shortValue());
-                            staProtocol.setStaNo(dto.getStaNo().shortValue());
+                        WrkMast wrkMast = wrkMastService.selectOne(new EntityWrapper<WrkMast>().eq("crn_no", staDesc.getCrnNo()).gt("io_type", 100));
+                        if (!Cools.isEmpty(wrkMast)){
+                            continue;
+                        }
+
+                        if (basDevp.getAutoing().equals("Y") && basDevp.getLoading().equals("N")
+                                && basDevp.getWrkNo() == 0 && basDevp.getCanining().equals("Y")){
+//                             鏇存柊绔欑偣淇℃伅 涓� 涓嬪彂plc鍛戒护
+                            staProtocol.setWorkNo((short) 9997);
+                            staProtocol.setStaNo(basDevp.getDevNo().shortValue());
+//                            staProtocol.setStaNo((short) 1013);
                             devpThread.setPakMk(staProtocol.getSiteId(), false);
                             boolean result = MessageQueue.offer(SlaveType.Devp, devpThread.getSlave().getId(), new Task(2, staProtocol));
                             if (!result) {
                                 throw new CoolException("鏇存柊plc绔欑偣淇℃伅澶辫触");
                             }
-                        } else {
-                            log.error("璇锋眰鎺ュ彛澶辫触锛侊紒锛乽rl锛歿}锛況equest锛歿}锛況esponse锛歿}", wmsUrl + "/rpc/pakin/loc/v1", JSON.toJSONString(param), response);
+                            return;
                         }
-                    } catch (Exception e) {
-                        e.printStackTrace();
-                        TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
+
                     }
 
+
+//                    try {
+//                        LocTypeDto locTypeDto = new LocTypeDto(staProtocol);
+//
+//                        SearchLocParam param = new SearchLocParam();
+//                        param.setIoType(10);
+//                        param.setSourceStaNo(sta.getStaNo());
+//                        param.setLocType1(locTypeDto.getLocType1());
+//                        String response = new HttpHandler.Builder()
+//                                .setUri(wmsUrl)
+//                                .setPath("/rpc/pakin/loc/v1")
+//                                .setJson(JSON.toJSONString(param))
+//                                .build()
+//                                .doPost();
+//                        JSONObject jsonObject = JSON.parseObject(response);
+//                        if (jsonObject.getInteger("code").equals(200)) {
+//                            StartupDto dto = jsonObject.getObject("data", StartupDto.class);
+//
+//                            // 鏇存柊绔欑偣淇℃伅 涓� 涓嬪彂plc鍛戒护
+//                            staProtocol.setWorkNo(dto.getWorkNo().shortValue());
+//                            staProtocol.setStaNo(dto.getStaNo().shortValue());
+//                            devpThread.setPakMk(staProtocol.getSiteId(), false);
+//                            boolean result = MessageQueue.offer(SlaveType.Devp, devpThread.getSlave().getId(), new Task(2, staProtocol));
+//                            if (!result) {
+//                                throw new CoolException("鏇存柊plc绔欑偣淇℃伅澶辫触");
+//                            }
+//                        } else {
+//                            log.error("璇锋眰鎺ュ彛澶辫触锛侊紒锛乽rl锛歿}锛況equest锛歿}锛況esponse锛歿}", wmsUrl + "/rpc/pakin/loc/v1", JSON.toJSONString(param), response);
+//                        }
+//                    } catch (Exception e) {
+//                        e.printStackTrace();
+//                        TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
+//                    }
                 }
             }
         }
@@ -2273,10 +2125,10 @@
      * 鎵弿鎷嗙洏鏈鸿嚜鍔ㄥ嚭搴撶┖鎵樼洏
      */
     public synchronized void autoEmptyOut() {
-        for (CrnSlave crnSlave : slaveProperties.getCrn()) {
-            for (CrnSlave.CrnStn emptyOutStn : crnSlave.getEmptyCrnOutStn()) {
-                DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, emptyOutStn.getDevpPlcId());
-                StaProtocol staProtocol = devpThread.getStation().get(emptyOutStn.getStaNo());
+        for (DevpSlave slave : slaveProperties.getDevp()) {
+            for (DevpSlave.Sta sta : slave.getAutoEmptyOut()) {
+                DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, slave.getId());
+                StaProtocol staProtocol = devpThread.getStation().get(sta.getStaNo());
                 if (staProtocol == null) {
                     return;
                 } else {
@@ -2285,37 +2137,465 @@
 
                 if (staProtocol.isAutoing()  //鑷姩
                         && !staProtocol.isLoading()  //鏃犵墿
-                        && staProtocol.isOutEnable()  //鍙嚭淇″彿
+                        && staProtocol.isEmptyOutPalletRequire()  //绌烘墭鐩橀渶姹備俊鍙�
+//                        && staProtocol.isEmptyMk()
                         && staProtocol.getWorkNo() == 0
                 ) {
-                    WrkMast pakoutEmpty = wrkMastMapper.selectPakoutEmpty(emptyOutStn.getStaNo());
+                    WrkMast pakoutEmpty = wrkMastMapper.selectPakoutEmpty(sta.getStaNo());
                     if (null != pakoutEmpty) {
                         return;
                     }
-                    try {
-                        HashMap<String, Object> map = new HashMap<>();
-                        map.put("crnNo", crnSlave.getId());
-                        String response = new HttpHandler.Builder()
-                                .setUri(wmsUrl)
-                                .setParams(map)
-                                .setPath("/rpc/auto/emptyOut/v1")
-                                .build()
-                                .doPost();
-                        JSONObject jsonObject = JSON.parseObject(response);
-                        if (jsonObject.getInteger("code").equals(200)) {
-                            JSONObject data = (JSONObject) jsonObject.get("data");
-                            log.info((String) data.get("msg"));
-                        } else {
-                            log.error("璇锋眰鎺ュ彛澶辫触锛侊紒锛乽rl锛歿}锛況equest锛歿}锛況esponse锛歿}", wmsUrl + "/rpc/auto/emptyOut/v1","", response);
+                    List<StaDesc> staDescs = staDescService.selectList(new EntityWrapper<StaDesc>().eq("stn_no", sta.getStaNo()));
+                    for (StaDesc staDesc: staDescs){
+                        BasCrnp basCrnp = basCrnpService.selectOne(new EntityWrapper<BasCrnp>().eq("crn_no", staDesc.getCrnNo()));
+                        if (!basCrnp.getCrnSts().equals(3) || basCrnp.getCrnErr() != 0){
+                            continue;
                         }
-                    } catch (Exception e) {
-                        e.printStackTrace();
-                        TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
+                        try {
+                            HashMap<String, Object> map = new HashMap<>();
+                            map.put("crnNo", staDesc.getCrnNo());//鐩爣绔�
+                            String response = new HttpHandler.Builder()
+                                    .setUri(wmsUrl)
+                                    .setParams(map)
+                                    .setPath("/rpc/auto/emptyOut/v1")
+                                    .build()
+                                    .doPost();
+                            JSONObject jsonObject = JSON.parseObject(response);
+                            if (jsonObject.getInteger("code").equals(200)) {
+                                JSONObject data = (JSONObject) jsonObject.get("data");
+                                log.info((String) data.get("msg"));
+                                return;
+                            } else {
+                                log.error("璇锋眰鎺ュ彛澶辫触锛侊紒锛乽rl锛歿}锛況equest锛歿}锛況esponse锛歿}", wmsUrl + "/rpc/auto/emptyOut/v1","", response);
+                            }
+                        } catch (Exception e) {
+                            e.printStackTrace();
+                            TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
+                        }
                     }
+
                 }
             }
+
         }
 
     }
 
+    public synchronized void crn5InTask(){
+        for (CrnSlave crnSlave : slaveProperties.getCrn()) {
+            if (crnSlave.getId() != 5){
+                continue;
+            }
+            // 鑾峰彇鍫嗗灈鏈轰俊鎭�
+            CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn, crnSlave.getId());
+            CrnProtocol crnProtocol = crnThread.getCrnProtocol();
+            if (crnProtocol == null) {
+                continue;
+            }
+            BasCrnp basCrnp = basCrnpService.selectById(crnSlave.getId());
+            if (basCrnp == null) {
+                log.error("{}鍙峰爢鍨涙満灏氭湭鍦ㄦ暟鎹簱杩涜缁存姢锛�", crnSlave.getId());
+                continue;
+            }
+            // 鍙湁褰撳爢鍨涙満绌洪棽 骞朵笖 鏃犱换鍔℃椂鎵嶇户缁墽琛�
+            if (crnProtocol.getStatusType() == CrnStatusType.IDLE && crnProtocol.getTaskNo() == 0 && crnProtocol.getModeType() == CrnModeType.AUTO
+                    && crnProtocol.getLoaded() == 0 && crnProtocol.getForkPos() == 0) {
+
+//                Crn5InTaskSta(crnSlave,crnProtocol);
+
+                // 濡傛灉鏈�杩戜竴娆℃槸鍏ュ簱妯″紡
+                if (crnProtocol.getLastIo().equals("I")) {
+                    if (basCrnp.getInEnable().equals("Y")) {
+                        this.Crn5InTaskSta(crnSlave,crnProtocol);
+                        crnProtocol.setLastIo("O");
+                    } else if (basCrnp.getOutEnable().equals("Y")) {
+                        this.locToCrn5Stn(crnSlave, crnProtocol); //  鍑哄簱
+                        crnProtocol.setLastIo("I");
+                    }
+                }
+                // 濡傛灉鏈�杩戜竴娆℃槸鍑哄簱妯″紡
+                else if (crnProtocol.getLastIo().equals("O")) {
+                    if (basCrnp.getOutEnable().equals("Y")) {
+                        this.locToCrn5Stn(crnSlave, crnProtocol); //  鍑哄簱
+                        crnProtocol.setLastIo("I");
+                    } else if (basCrnp.getInEnable().equals("Y")) {
+
+                        this.Crn5InTaskSta(crnSlave,crnProtocol);
+                        crnProtocol.setLastIo("O");
+                    }
+                }
+
+            }
+
+        }
+    }
+    public void Crn5InTaskSta(CrnSlave slave, CrnProtocol crnProtocol){
+        for (CrnSlave.CrnStn crnStn : slave.getCrnInStn()) {
+            // 鏌ヨ宸ヤ綔妗�
+            WrkMast wrkMast = wrkMastMapper.selectCrn5Task2();
+            if (wrkMast == null) {
+                return;
+            }
+            // 鑾峰彇搴撲綅淇℃伅
+            LocMast locMast = locMastService.selectById(wrkMast.getLocNo());
+            if (locMast == null) {
+                log.error("鏌ヨ搴撳瓨鏃犳暟鎹�--搴撲綅鍙穥}", wrkMast.getLocNo());
+                return;
+            }
+            if (!locMast.getLocSts().equals("S") && !locMast.getLocSts().equals("Q")) {
+                log.error("鍏ュ簱鎿嶄綔搴撲綅鐘舵�佷笉绗﹀悎--鐘舵��, 搴撲綅鍙�={}锛屽簱浣嶇姸鎬�={}", wrkMast.getLocNo(), locMast.getLocSts());
+                return;
+            }
+            // 鍫嗗灈鏈烘帶鍒惰繃婊�
+            if (!crnProtocol.getStatusType().equals(CrnStatusType.IDLE) || crnProtocol.getTaskNo() != 0) {
+                return;
+            }
+
+            // 鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
+            CrnCommand crnCommand = new CrnCommand();
+            crnCommand.setCrnNo(slave.getId()); // 鍫嗗灈鏈虹紪鍙�
+            crnCommand.setTaskNo(wrkMast.getWrkNo().shortValue()); // 宸ヤ綔鍙�
+            crnCommand.setAckFinish((short) 0);  // 浠诲姟瀹屾垚纭浣�
+            crnCommand.setTaskMode(CrnTaskModeType.LOC_MOVE); // 浠诲姟妯″紡:  搴撲綅绉昏浆
+            crnCommand.setSourcePosX(crnStn.getRow().shortValue());     // 婧愬簱浣嶆帓
+            crnCommand.setSourcePosY(crnStn.getBay().shortValue());     // 婧愬簱浣嶅垪
+            crnCommand.setSourcePosZ(crnStn.getLev().shortValue());     // 婧愬簱浣嶅眰
+            crnCommand.setDestinationPosX(locMast.getRow1()==9?(short)4:(short)5);     // 鐩爣搴撲綅鎺�
+            crnCommand.setDestinationPosY(locMast.getBay1().shortValue());     // 鐩爣搴撲綅鍒�
+            crnCommand.setDestinationPosZ(locMast.getLev1().shortValue());     // 鐩爣搴撲綅灞�
+            crnCommand.setLocType1(locMast.getLocType1().shortValue());     // 璐х墿绫诲瀷
+            if (!MessageQueue.offer(SlaveType.Crn, wrkMast.getCrnNo(), new Task(2, crnCommand))) {
+                log.error("鍫嗗灈鏈哄懡浠や笅鍙戝け璐ワ紝鍫嗗灈鏈哄彿={}锛屼换鍔℃暟鎹�={}", wrkMast.getCrnNo(), JSON.toJSON(crnCommand));
+            } else {
+                // 淇敼宸ヤ綔妗g姸鎬� 2.璁惧涓婅蛋 => 3.鍚婅溅鍏ュ簱涓�
+                Date now = new Date();
+                wrkMast.setWrkSts(3L);
+                wrkMast.setCrnStrTime(now);
+                wrkMast.setModiTime(now);
+                if (wrkMastMapper.updateById(wrkMast) == 0) {
+                    log.error("淇敼宸ヤ綔妗g姸鎬� 2.璁惧涓婅蛋 => 3.鍚婅溅鍏ュ簱涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
+                }
+            }
+        }
+
+
+
+
+    }
+
+
+    public synchronized void crn5StnToOutStn() {
+        for (CrnSlave crnSlave : slaveProperties.getCrn()) {
+            if (crnSlave.getId() != 5){
+                continue;
+            }
+            // 閬嶅巻鍫嗗灈鏈哄嚭搴撶珯
+            for (CrnSlave.CrnStn crnStn : crnSlave.getCrnOutStn()) {
+                // 鑾峰彇鍫嗗灈鏈哄嚭搴撶珯淇℃伅
+                DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, crnStn.getDevpPlcId());
+                StaProtocol staProtocol = devpThread.getStation().get(crnStn.getStaNo());
+                if (staProtocol == null) {
+                    continue;
+                } else {
+                    staProtocol = staProtocol.clone();
+                }
+                if (staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.isInEnable()) {
+                    // 鏌ヨ宸ヤ綔妗�
+                    WrkMast wrkMast = wrkMastMapper.selectPakOutStep2(crnStn.getStaNo());
+                    if (wrkMast == null) {
+                        continue;
+                    }
+                    // 鍒ゆ柇宸ヤ綔妗f潯浠�
+                    if (wrkMast.getIoType() < 100 || wrkMast.getStaNo() == null || wrkMast.getSourceStaNo() == null) {
+                        continue;
+                    }
+                    // 鍒ゆ柇鍚婅溅鏄惁瀹為檯宸插畬鎴愶紝涓旂數鑴戠姸鎬佸湪move涓紝浠ュ鐢佃剳杩涜鏇存柊宸ヤ綔妗�
+                    CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn, wrkMast.getCrnNo());
+                    CrnProtocol crnProtocol = crnThread.getCrnProtocol();
+                    if (crnProtocol.statusType == CrnStatusType.FETCHING || crnProtocol.statusType == CrnStatusType.PUTTING) {
+                        // 绉诲姩涓�
+                        continue;
+                    }
+                    //  鍒ゆ柇鍫嗗灈鏈虹姸鎬佺瓑寰呯‘璁�
+                    if (crnProtocol.modeType == CrnModeType.AUTO && crnProtocol.getTaskNo().equals(wrkMast.getWrkNo().shortValue())
+                            && crnProtocol.statusType == CrnStatusType.WAITING
+                            && crnProtocol.forkPosType == CrnForkPosType.HOME) {
+
+                            // 鏇存柊宸ヤ綔妗g姸鎬佷负14
+                            wrkMast.setWrkSts(14L);
+
+                        wrkMast.setCrnEndTime(new Date());
+                        if (wrkMastMapper.updateById(wrkMast) != 0) {
+                            // 澶嶄綅鍫嗗灈鏈�
+                            crnThread.setResetFlag(true);
+                        } else {
+                            log.error("鏇存柊宸ヤ綔妗g殑宸ヤ綔鐘舵�佷负14澶辫触锛侊紒锛� [宸ヤ綔鍙�:{}]", wrkMast.getWrkNo());
+                        }
+
+                    }
+
+                }
+            }
+        }
+    }
+
+
+    public synchronized void locToCrn5Stn(CrnSlave slave, CrnProtocol crnProtocol) {
+        for (CrnSlave.CrnStn crnStn : slave.getCrnOutStn()) {
+            // 鑾峰彇宸ヤ綔鐘舵�佷负11锛堢敓鎴愬嚭搴揑D锛夌殑鍑哄簱宸ヤ綔妗�
+//            WrkMast wrkMast = wrkMastMapper.selectPakOutStep1(slave.getId(), crnStn.getStaNo());
+            List<WrkMast> wrkMasts = wrkMastMapper.selectPakOutStep11(slave.getId(), crnStn.getStaNo());
+            //            鑾峰彇宸ヤ綔鐘舵�佷负14鐨勫伐浣滄。
+            WrkMast wrkMast1 = wrkMastMapper.selectPakOutStep14(slave.getId(), crnStn.getStaNo());
+            if ( wrkMast1 !=null) {
+                continue;
+            }
+            for (WrkMast wrkMast : wrkMasts) {
+                if (wrkMast == null) {
+                    continue;
+                }
+                // 宸ヤ綔妗g姸鎬佸垽鏂�
+                if (wrkMast.getIoType() < 100 || wrkMast.getSourceStaNo() == null) {
+                    log.error("鏌ヨ宸ヤ綔妗f暟鎹笉绗﹀悎鏉′欢--鍏ュ嚭绫诲瀷/绔欑偣, 宸ヤ綔鍙�={}锛屾簮搴撲綅={}锛屽叆鍑虹被鍨�={}", wrkMast.getWrkNo(), wrkMast.getSourceLocNo(), wrkMast.getIoType());
+                    continue;
+                }
+                // 鑾峰彇婧愬簱浣嶄俊鎭�
+                LocMast locMast = locMastService.selectById(wrkMast.getSourceLocNo());
+                if (!locMast.getLocSts().equals("R") && !locMast.getLocSts().equals("P")) {
+                    log.error("鍑哄簱鎿嶄綔搴撲綅鐘舵�佷笉绗﹀悎--鐘舵��, 搴撲綅鍙�={}锛屽簱浣嶇姸鎬�={}", wrkMast.getLocNo(), locMast.getLocSts());
+                    continue;
+                }
+                // 鑾峰彇鍫嗗灈鏈哄嚭搴撶珯淇℃伅
+                SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, crnStn.getDevpPlcId());
+                StaProtocol staProtocol = devpThread.getStation().get(crnStn.getStaNo());
+                if (staProtocol == null) {
+                    break;
+//                    continue;
+                } else {
+                    staProtocol = staProtocol.clone();
+                }
+
+                // 鏌ヨ绔欑偣璇︾粏淇℃伅
+                BasDevp staDetl = basDevpService.selectById(crnStn.getStaNo());
+                if (staDetl == null) {
+                    log.error("鍑哄簱 ===>> 鍫嗗灈鏈虹珯鐐瑰湪鏁版嵁搴撲笉瀛樺湪, 绔欑偣缂栧彿={}", crnStn.getStaNo());
+                    break;
+//                    continue;
+                }
+                // 鍒ゆ柇鍫嗗灈鏈哄嚭搴撶珯鐘舵��
+                if (staProtocol.isAutoing() && !staProtocol.isLoading() && staProtocol.isOutEnable()) {
+                    // 鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
+
+                    // 鍫嗗灈鏈烘帶鍒惰繃婊�
+                    if (!crnProtocol.getStatusType().equals(CrnStatusType.IDLE) || crnProtocol.getTaskNo() != 0) {
+//                        continue;
+                        break;
+                    }
+
+
+                    // 宸茬粡瀛樺湪鍚婅溅鎵ц浠诲姟鏃讹紝鍒欒繃婊�
+                    if (wrkMastMapper.selectWorking(slave.getId()) != null) {
+                        break;
+//                        return;
+                    }
+
+                    // 1.鍫嗗灈鏈哄紑濮嬬Щ鍔�
+                    CrnCommand crnCommand = new CrnCommand();
+                    crnCommand.setCrnNo(slave.getId()); // 鍫嗗灈鏈虹紪鍙�
+                    crnCommand.setTaskNo(wrkMast.getWrkNo().shortValue()); // 宸ヤ綔鍙�
+                    crnCommand.setAckFinish((short) 0);  // 浠诲姟瀹屾垚纭浣�
+                    crnCommand.setTaskMode(CrnTaskModeType.LOC_MOVE); // 浠诲姟妯″紡:  搴撲綅绉昏浆
+                    crnCommand.setSourcePosX(locMast.getRow1()==9?(short)4:(short)5);     // 婧愬簱浣嶆帓
+                    crnCommand.setSourcePosY(locMast.getBay1().shortValue());     // 婧愬簱浣嶅垪
+                    crnCommand.setSourcePosZ(locMast.getLev1().shortValue());     // 婧愬簱浣嶅眰
+                    crnCommand.setDestinationPosX(crnStn.getRow().shortValue());     // 鐩爣搴撲綅鎺�
+                    crnCommand.setDestinationPosY(crnStn.getBay().shortValue());     // 鐩爣搴撲綅鍒�
+                    crnCommand.setDestinationPosZ(crnStn.getLev().shortValue());     // 鐩爣搴撲綅灞�
+                    crnCommand.setLocType1(locMast.getLocType1().shortValue());     // 璐х墿绫诲瀷
+                    if (!MessageQueue.offer(SlaveType.Crn, wrkMast.getCrnNo(), new Task(2, crnCommand))) {
+                        log.error("鍫嗗灈鏈哄懡浠や笅鍙戝け璐ワ紝鍫嗗灈鏈哄彿={}锛屼换鍔℃暟鎹�={}", wrkMast.getCrnNo(), JSON.toJSON(crnCommand));
+                    } else {
+                        // 淇敼宸ヤ綔妗g姸鎬� 11.鐢熸垚鍑哄簱ID => 12.鍚婅溅鍑哄簱涓�
+                        Date now = new Date();
+                        wrkMast.setWrkSts(12L);
+                        wrkMast.setCrnStrTime(now);
+                        wrkMast.setModiTime(now);
+                        if (wrkMastMapper.updateById(wrkMast) == 0) {
+                            log.error("淇敼宸ヤ綔妗g姸鎬� 11.鐢熸垚鍑哄簱ID => 12.鍚婅溅鍑哄簱涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
+                        }
+                        break;
+                    }
+                }
+            }
+        }
+    }
+
+    public synchronized void crn5TaskCreate() throws IOException {
+        for (CrnSlave crnSlave : slaveProperties.getCrn()) {
+            if (crnSlave.getId() != 5){
+                continue;
+            }
+            for (CrnSlave.CrnStn crnStn : crnSlave.getCrnInStn()) {
+                // 鑾峰彇鍫嗗灈鏈哄嚭搴撶珯淇℃伅
+                SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, crnStn.getDevpPlcId());
+                StaProtocol staProtocol = devpThread.getStation().get(crnStn.getStaNo());
+                if (staProtocol == null) {
+                    break;
+//                    continue;
+                } else {
+                    staProtocol = staProtocol.clone();
+                }
+                if (staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.isInEnable() && staProtocol.isPakMk()){
+
+                    EmptyBarrelIn emptyBarrelIn = emptyBarrelInService.selectOne(new EntityWrapper<>());
+                    if (Cools.isEmpty(emptyBarrelIn)){
+                        continue;
+                    }
+
+                    FullStoreParam fullStoreParam = new FullStoreParam();
+                    fullStoreParam.setDevpNo(crnStn.getStaNo());
+                    FullStoreParam.MatCodeStore matCodeStore = new FullStoreParam.MatCodeStore();
+                    matCodeStore.setMatnr(emptyBarrelIn.getMatnr());
+                    matCodeStore.setBatch(emptyBarrelIn.getBatch());
+                    if (staProtocol.isForce()){
+                        log.info("绌烘《寮哄埗鍏ュ簱锛�"+staProtocol.getAmount());
+                        matCodeStore.setAnfme(Double.valueOf(staProtocol.getAmount()));
+                    }else {
+                        matCodeStore.setAnfme(8d) ;
+                    }
+                    ArrayList<FullStoreParam.MatCodeStore> matCodeStores = new ArrayList<>();
+                    matCodeStores.add(matCodeStore);
+                    fullStoreParam.setList(matCodeStores);
+                    try {
+                        String response = new HttpHandler.Builder()
+                                .setUri(wmsUrl)
+                                .setPath("/full/store/put/start")
+                                .setJson(JSON.toJSONString(fullStoreParam))
+                                .build()
+                                .doPost();
+                        JSONObject jsonObject = JSON.parseObject(response);
+                        if (jsonObject.getInteger("code").equals(200)) {
+                            devpThread.setPakMk(crnStn.getStaNo(),false);
+                        }
+                    }catch (CoolException e){
+
+                    }
+
+                }
+
+            }
+        }
+    }
+
+    public synchronized void RGVTaskPut(){
+        for (RgvSlave rgvSlave:slaveProperties.getRgv()){
+            ZyRgvThread rgvThread = (ZyRgvThread)SlaveConnection.get(SlaveType.Rgv, rgvSlave.getId());
+            RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
+            if (rgvProtocol.getModeType() != RgvModeType.AUTO){
+                continue;
+            }
+
+
+            int workNo1 = 0;
+            int workNo2 = 0;
+            short souSta1 = 0;
+            short sta1 = 0;
+            short souSta2 = 0;
+            short sta2 = 0;
+
+            //宸ヤ綅涓�浠诲姟
+            for (RgvSlave.Sta inStn :  rgvSlave.getInStn()){
+                SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, inStn.getSourcePlcId());
+                StaProtocol staProtocol = devpThread.getStation().get(inStn.getSourceStaNo());
+                if (staProtocol == null) {
+                    break;
+//                    continue;
+                } else {
+                    staProtocol = staProtocol.clone();
+                }
+                if (staProtocol.isLoading() && staProtocol.isLoading() && staProtocol.isInEnable()){
+                    if (staProtocol.getWorkNo() > 0 && staProtocol.getWorkNo() <9900){
+                        WrkMast wrkMast = wrkMastService.selectByworkNo(staProtocol.getWorkNo());
+                        if (Cools.isEmpty(wrkMast)){
+                            log.error("鏈壘鍒板伐浣滄。");
+                            continue;
+                        }
+                        workNo1 = wrkMast.getWrkNo();
+                        souSta1 = inStn.getSourceStaNo().shortValue();
+                        sta1 = Utils.getRgvEndStaNo(rgvSlave.getId(),wrkMast.getStaNo());
+                        break;
+                    }
+                    workNo1 = workNo++;
+                    souSta1 = inStn.getSourceStaNo().shortValue();
+                    sta1 = inStn.getStaNo().shortValue();
+                    break;
+                }
+            }
+
+
+            //宸ヤ綅浜屼换鍔�
+            for (RgvSlave.Sta inStn :  rgvSlave.getInStn()){
+                if (souSta1 == inStn.getSourceStaNo()){
+                    continue;
+                }
+                SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, inStn.getSourcePlcId());
+                StaProtocol staProtocol = devpThread.getStation().get(inStn.getSourceStaNo());
+                if (staProtocol == null) {
+                    break;
+//                    continue;
+                } else {
+                    staProtocol = staProtocol.clone();
+                }
+                if (staProtocol.isLoading() && staProtocol.isLoading() && staProtocol.isInEnable()){
+                    if (staProtocol.getWorkNo() > 0 && staProtocol.getWorkNo() <9900){
+                        WrkMast wrkMast = wrkMastService.selectByworkNo(staProtocol.getWorkNo());
+                        if (Cools.isEmpty(wrkMast)){
+                            log.error("鏈壘鍒板伐浣滄。");
+                            continue;
+                        }
+                        workNo2 = wrkMast.getWrkNo();
+                        souSta2 = inStn.getSourceStaNo().shortValue();
+                        sta2 = Utils.getRgvEndStaNo(rgvSlave.getId(),wrkMast.getStaNo());
+                        break;
+                    }
+                    workNo2 = workNo++;
+                    souSta2 = inStn.getSourceStaNo().shortValue();
+                    sta2 = inStn.getStaNo().shortValue();
+                    break;
+                }
+            }
+
+            //rgv浠诲姟涓嬪彂--------------------------------------------------------------
+            RgvCommand command = new RgvCommand();
+            command.setRgvNo(rgvSlave.getId()); // RGV缂栧彿
+            //宸ヤ綅1
+            command.setTaskNo1(workNo1); // 宸ヤ綔鍙�
+            command.setSourceStaNo1(souSta1); // 婧愮珯
+            command.setDestinationStaNo1(sta1);  // 鐩爣绔�
+            command.setAckFinish1(false);  // 浠诲姟瀹屾垚纭浣�
+
+            //宸ヤ綅2
+            command.setTaskNo2(workNo2); // 宸ヤ綔鍙�
+            command.setSourceStaNo2(souSta2); // 婧愮珯
+            command.setDestinationStaNo2(sta2);  // 鐩爣绔�
+            command.setAckFinish2(false);  // 浠诲姟瀹屾垚纭浣�
+
+            if (workNo1 != 0 && workNo2 ==0){
+                command.setTaskMode(RgvTaskModeType.FETCH_PUT2); // 浠诲姟妯″紡: 鍙栨斁璐�
+            } else if (workNo1 == 0 && workNo2 !=0) {
+                command.setTaskMode(RgvTaskModeType.FETCH_PUT1); // 浠诲姟妯″紡: 鍙栨斁璐�
+            }else {
+                command.setTaskMode(RgvTaskModeType.FETCH_PUT_ALL); // 浠诲姟妯″紡: 鍙栨斁璐�
+            }
+            command.setCommand(false);
+            MessageQueue.offer(SlaveType.Rgv, rgvSlave.getId(), new Task(2, command));
+            log.info("rgv浠诲姟涓嬪彂锛�"+JSON.toJSONString(command));
+
+        }
+    }
+
+
+    public synchronized void RGVTaskOver() {
+
+    }
 }

--
Gitblit v1.9.1