From a403410276a4e7744d5808004eae6dc3494aea4f Mon Sep 17 00:00:00 2001
From: lsh <lsh@163.com>
Date: 星期五, 24 十月 2025 14:30:13 +0800
Subject: [PATCH] *

---
 src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java |  797 ++++++++++++++++++++++++++++++++++++++++++++------------
 1 files changed, 628 insertions(+), 169 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 a828e56..2fa2bdb 100644
--- a/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java
+++ b/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java
@@ -9,6 +9,7 @@
 import com.core.common.R;
 import com.core.exception.CoolException;
 import com.zy.asrs.entity.*;
+import com.zy.asrs.entity.param.AgvTaskAssignmentParam;
 import com.zy.asrs.entity.param.ArmOrderAssignmentParam;
 import com.zy.asrs.entity.param.ArmTaskAssignmentParam;
 import com.zy.asrs.entity.param.CombParam;
@@ -20,6 +21,7 @@
 import com.zy.asrs.utils.Utils;
 import com.zy.asrs.utils.VersionUtils;
 import com.zy.asrs.utils.core.ReturnT;
+import com.zy.common.constant.AgvConstant;
 import com.zy.common.constant.ArmConstant;
 import com.zy.common.model.LocTypeDto;
 import com.zy.common.model.MatDto;
@@ -105,6 +107,8 @@
     private BasRgvMapService basRgvMapService;
     @Autowired
     private BasArmService basArmService;
+    @Autowired
+    private BasAgvMastService basAgvMastService;
     @Autowired
     private BasArmMastService basArmMastService;
     @Autowired
@@ -260,6 +264,7 @@
                             staProtocolNew.setWorkNo(wrkMast.getWrkNo());
                             staProtocolNew.setStaNo(RouteUtils.SouStaEnd(wrkMast.getStaNo(),wrkMast.getSourceStaNo()));
                             staProtocolNew.setSiteId(staProtocol.getSiteId());
+                            devpThread.setPakMk(staProtocol.getSiteId(), false);
                             staProtocolNew.setBarcode(barcode);
                             MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocolNew));
                             if (ledThread != null) {
@@ -283,10 +288,9 @@
                         if (!result) {
                             News.error(methodName + ":鏇存柊plc绔欑偣淇℃伅澶辫触");
                             log.error("杈撻�佺嚎涓嬪彂(瀛樺湪璁惧涓婅蛋鐨勫伐浣滄。锛岀洿鎺ヤ笅鍙戯紒)==>鏇存柊plc绔欑偣淇℃伅澶辫触");
-
-//                            throw new CoolException("鏇存柊plc绔欑偣淇℃伅澶辫触");
                             continue;
                         }
+                        continue;
 
                     }
                     WrkMast checkPick = wrkMastService.selectOne(new EntityWrapper<WrkMast>()
@@ -327,41 +331,14 @@
 
                                 throw new CoolException("鏇存柊plc绔欑偣淇℃伅澶辫触");
                             }
-                        }
-//                        else if (jsonObject.getInteger("code").equals(700)) {
-//                            SearchLocParam param2 = new SearchLocParam();
-//                            param2.setBarcode(barcode);
-//                            param2.setBarcodeMat(barcodeMat);
-//                            param2.setSourceStaNo(inSta.getStaNo());
-//                            param2.setLocType1(locTypeDto.getLocType1());
-//                            String response2 = new HttpHandler.Builder()
-//                                    .setUri(wmsUrl)
-//                                    .setPath("/rpc/pakin/yk/loc/v33")
-//                                    .setJson(JSON.toJSONString(param2))
-//                                    .build()
-//                                    .doPost();
-//                            JSONObject jsonObject2 = JSON.parseObject(response2);
-//                            if (jsonObject2.getInteger("code").equals(200)) {
-//                                log.info("鑷姩缁勬墭鎴愬姛锛侊紒");
-//                                MessageQueue.offer(SlaveType.Led, inSta.getLed(), new Task(3, "鑷姩缁勬墭鎴愬姛"));
-//                            } else {
-//                                MessageQueue.offer(SlaveType.Led, inSta.getLed(), new Task(3, "鑷姩缁勬墭澶辫触锛侊紒锛乥arcodeMat==>"+barcodeMat));
-//                                News.error(methodName + "==>缁勬墭澶辫触:璇锋眰鎺ュ彛澶辫触锛侊紒锛乽rl锛歿}锛況equest锛歿}锛況esponse锛歿}", wmsUrl + "/rpc/pakin/yk/loc/v33", JSON.toJSONString(param), response2);
-//                            }
-//                            try{
-//                                Thread.sleep(500);
-//                            } catch (Exception e){
-//
-//                            }
-//                        }
-                        else {
+                        } else {
                             News.error(JSON.toJSONString(staProtocol));
                             staProtocol.setWorkNo(wrkNo);
-                            wrkNo++;
                             staProtocol.setStaNo(inSta.getBackSta().shortValue());
                             devpThread.setPakMk(staProtocol.getSiteId(), false);
                             MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
-                            News.info("浠诲姟涓嬪彂鍒ゆ柇{}鍏ュ簱鍥為��锛歿}锛屼换鍔″彿锛歿}", inSta.getStaNo(), errMsg,wrkNo);
+                            News.info("浠诲姟涓嬪彂鍒ゆ柇{}鍏ュ簱鍥為��锛歿}锛岄敊璇紪鍙穥},浠诲姟鍙凤細{}", inSta.getStaNo(), errMsg,jsonObject.getInteger("code"),wrkNo);
+                            wrkNo++;
 //                            if (ledThread != null) {
                                 String errorMsg = jsonObject.getString("msg");
                                 if (!Cools.isEmpty(errorMsg)) {
@@ -518,10 +495,10 @@
                     if (Cools.isEmpty(staDesc)) {
                         News.error(""+mark+" - 2"+" - 鍏ュ簱璺緞涓嶅瓨鍦紒type_no={},stn_no={},crn_no={}", wrkMast.getIoType(), pickSta.getStaNo(), wrkMast.getCrnNo());
                         staProtocol.setWorkNo(wrkNo++);
-                        staProtocol.setStaNo((short) (pickSta.getStaNo().shortValue()-(short)1));
+                        staProtocol.setStaNo((short) (pickSta.getStaNo().shortValue()));
                         devpThread.setPakMk(staProtocol.getSiteId(), false);
                         MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
-                        log.error("杈撻�佺嚎涓嬪彂4锛�"+9989+","+(pickSta.getStaNo().shortValue()-(short)1));
+                        log.error("杈撻�佺嚎涓嬪彂4锛�"+9996+","+(pickSta.getStaNo().shortValue()-(short)1));
                         //LED
                         LedThread ledThread = (LedThread) SlaveConnection.get(SlaveType.Led, pickSta.getLed());
                         // led 寮傚父鏄剧ず
@@ -545,6 +522,14 @@
                         Date now = new Date();
                         // 鍫嗗灈鏈虹珯鐐�(鐩爣绔�)
                         Integer staNo = staDesc.getCrnStn();
+                        if(wrkMast.getSourceStaNo() > 2000){
+                            switch (wrkMast.getCrnNo()){
+                                case 1: staNo = 2004;break;
+                                case 2: staNo = 2010;break;
+                                case 4: staNo = 2022;break;
+                                case 5: staNo = 2028;break;
+                            }
+                        }
                         // 鏇存柊宸ヤ綔妗f暟鎹姸鎬�
                         wrkMast.setIoTime(now);
                         wrkMast.setIoType(wrkMast.getIoType() - 50); // 鍏ュ嚭搴撶被鍨�: 103->53,104->54,107->57
@@ -574,7 +559,7 @@
 
                     // 鏇存柊绔欑偣淇℃伅 涓� 涓嬪彂plc鍛戒护
                     staProtocol.setWorkNo(wrkMast.getWrkNo());
-                    staProtocol.setStaNo((short) 161);
+                    staProtocol.setStaNo(wrkMast.getStaNo().shortValue());
                     devpThread.setPakMk(staProtocol.getSiteId(), false);
                     boolean result = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
                     log.error("杈撻�佺嚎涓嬪彂5锛�"+wrkMast.getWrkNo()+","+wrkMast.getStaNo());
@@ -774,6 +759,101 @@
                     staProtocol = staProtocol.clone();
                 }
                 if (staProtocol.isAutoing() && staProtocol.isLoading() && (staProtocol.getWorkNo() == 0 || staProtocol.getStaNo() == null)) {
+                    WrkMast wrkMast9997 = wrkMastMapper.selectPakOutStep9997(staProtocol.getSiteId());
+                    WrkMast wrkMast9996 = wrkMastMapper.selectPakOutStep9996(staProtocol.getSiteId());
+
+                    if(crnSlave.getId() == 3 && wrkMast9997 != null){
+                        WrkMast wrkMast107 = wrkMastMapper.selectPakOutStep107(wrkMast9997.getBarcode());
+                        // 鍒ゆ柇鍚婅溅鏄惁瀹為檯宸插畬鎴愶紝涓旂數鑴戠姸鎬佸湪move涓紝浠ュ鐢佃剳杩涜鏇存柊宸ヤ綔妗�
+                        CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn,3);
+                        CrnProtocol crnProtocol = crnThread.getCrnProtocol();
+                        if (crnProtocol.statusType == CrnStatusType.FETCHING || crnProtocol.statusType == CrnStatusType.PUTTING) {
+                            // 绉诲姩涓�
+                            continue;
+                        }
+                        //  鍒ゆ柇鍫嗗灈鏈虹姸鎬佺瓑寰呯‘璁�
+                        if (crnProtocol.modeType == CrnModeType.AUTO &&  crnProtocol.getTaskNo()== 9997
+                                && crnProtocol.statusType == CrnStatusType.WAITING
+                                && crnProtocol.forkPosType == CrnForkPosType.HOME) {
+                            log.info("鍫嗗灈鏈哄嚭搴撳畬鎴� - 寮�濮嬫墽琛�");
+
+                            // 鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
+
+                            // 涓嬪彂绔欑偣淇℃伅
+                            staProtocol.setWorkNo(wrkMast107.getWrkNo());
+                            staProtocol.setStaNo(RouteUtils.CrnStaEnd(wrkMast107.getStaNo(),wrkMast107.getSourceStaNo()));
+                            if (!MessageQueue.offer(SlaveType.Devp, crnStn.getDevpPlcId(), new Task(2, staProtocol))) {
+                                log.info(staProtocol.getWorkNo()+","+staProtocol.getStaNo()+"杈撻�佺嚎鍑哄簱鍛戒护涓嬪彂澶辫触");
+                                continue;
+                            }else {
+                                log.info(staProtocol.getWorkNo()+","+staProtocol.getStaNo()+"杈撻�佺嚎鍑哄簱鍛戒护涓嬪彂鎴愬姛");
+                            }
+
+                            // 鏇存柊宸ヤ綔妗g姸鎬佷负14澶辫触
+                            wrkMast9997.setWrkSts(14L);
+                            wrkMast9997.setCrnEndTime(new Date());
+                            if (wrkMastMapper.updateById(wrkMast9997) != 0) {
+                                // 澶嶄綅鍫嗗灈鏈�
+                                log.error("鍑哄簱浠诲姟瀹屾垚涓嬪彂鍫嗗灈鏈哄浣�,{}", wrkMast9997.getWrkNo());
+                                crnThread.setResetFlag(true);
+                            } else {
+                                News.error(""+mark+" - 1"+" - 鏇存柊宸ヤ綔妗g殑宸ヤ綔鐘舵�佷负14澶辫触锛侊紒锛� [宸ヤ綔鍙�:{}]", wrkMast9997.getWrkNo());
+                            }
+
+                        }else {
+                            News.errorNoLog(""+mark+" - 6"+" - 鍫嗗灈鏈轰俊鎭笉绗﹀悎鍏ュ簱鏉′欢锛侊紒锛�"
+                                    +" 鍫嗗灈鏈虹姸鎬侊細"+crnProtocol.modeType+"==鑷姩AUTO锛�" + CrnModeType.AUTO
+                                    +"銆佸爢鍨涙満浠诲姟鍙凤細"+crnProtocol.getTaskNo()+"==宸ヤ綔妗d换鍔″彿锛�" + wrkMast9997.getWrkNo().shortValue()
+                                    +"銆佺姸鎬佹灇涓撅細"+crnProtocol.statusType+"==WAITING锛�90 //浠诲姟瀹屾垚绛夊緟WCS纭)锛�" + CrnStatusType.WAITING
+                                    +"銆佽揣鍙変綅缃細"+crnProtocol.forkPosType+"==HOME锛�0  // 璐у弶鍘熶綅锛�" + CrnForkPosType.HOME);
+                        }
+                    }
+                    if(crnSlave.getId() == 3 && wrkMast9996 != null){
+                        WrkMast wrkMast107 = wrkMastMapper.selectPakOutStep107(wrkMast9996.getBarcode());
+                        // 鍒ゆ柇鍚婅溅鏄惁瀹為檯宸插畬鎴愶紝涓旂數鑴戠姸鎬佸湪move涓紝浠ュ鐢佃剳杩涜鏇存柊宸ヤ綔妗�
+                        CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn, 3);
+                        CrnProtocol crnProtocol = crnThread.getCrnProtocol();
+                        if (crnProtocol.statusType == CrnStatusType.FETCHING || crnProtocol.statusType == CrnStatusType.PUTTING) {
+                            // 绉诲姩涓�
+                            continue;
+                        }
+                        //  鍒ゆ柇鍫嗗灈鏈虹姸鎬佺瓑寰呯‘璁�
+                        if (crnProtocol.modeType == CrnModeType.AUTO && crnProtocol.getTaskNo() == 9996
+                                && crnProtocol.statusType == CrnStatusType.WAITING
+                                && crnProtocol.forkPosType == CrnForkPosType.HOME) {
+                            log.info("鍫嗗灈鏈哄嚭搴撳畬鎴� - 寮�濮嬫墽琛�");
+
+                            // 鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
+
+                            // 涓嬪彂绔欑偣淇℃伅
+                            staProtocol.setWorkNo(wrkMast107.getWrkNo());
+                            staProtocol.setStaNo(RouteUtils.CrnStaEnd(wrkMast107.getStaNo(),wrkMast107.getSourceStaNo()));
+                            if (!MessageQueue.offer(SlaveType.Devp, crnStn.getDevpPlcId(), new Task(2, staProtocol))) {
+                                log.info(staProtocol.getWorkNo()+","+staProtocol.getStaNo()+"杈撻�佺嚎鍑哄簱鍛戒护涓嬪彂澶辫触");
+                                continue;
+                            }else {
+                                log.info(staProtocol.getWorkNo()+","+staProtocol.getStaNo()+"杈撻�佺嚎鍑哄簱鍛戒护涓嬪彂鎴愬姛");
+                            }
+
+                            // 鏇存柊宸ヤ綔妗g姸鎬佷负14澶辫触
+                            wrkMast9996.setWrkSts(14L);
+                            wrkMast9996.setCrnEndTime(new Date());
+                            if (wrkMastMapper.updateById(wrkMast9996) != 0) {
+                                // 澶嶄綅鍫嗗灈鏈�
+                                log.error("鍑哄簱浠诲姟瀹屾垚涓嬪彂鍫嗗灈鏈哄浣�,{}", wrkMast9996.getWrkNo());
+                                crnThread.setResetFlag(true);
+                            } else {
+                                News.error(""+mark+" - 1"+" - 鏇存柊宸ヤ綔妗g殑宸ヤ綔鐘舵�佷负14澶辫触锛侊紒锛� [宸ヤ綔鍙�:{}]", wrkMast9996.getWrkNo());
+                            }
+
+                        }else {
+                            News.errorNoLog(""+mark+" - 6"+" - 鍫嗗灈鏈轰俊鎭笉绗﹀悎鍏ュ簱鏉′欢锛侊紒锛�"
+                                    +" 鍫嗗灈鏈虹姸鎬侊細"+crnProtocol.modeType+"==鑷姩AUTO锛�" + CrnModeType.AUTO
+                                    +"銆佸爢鍨涙満浠诲姟鍙凤細"+crnProtocol.getTaskNo()+"==宸ヤ綔妗d换鍔″彿锛�" + wrkMast9996.getWrkNo().shortValue()
+                                    +"銆佺姸鎬佹灇涓撅細"+crnProtocol.statusType+"==WAITING锛�90 //浠诲姟瀹屾垚绛夊緟WCS纭)锛�" + CrnStatusType.WAITING
+                                    +"銆佽揣鍙変綅缃細"+crnProtocol.forkPosType+"==HOME锛�0  // 璐у弶鍘熶綅锛�" + CrnForkPosType.HOME);
+                        }
+                    }
                     // 鏌ヨ宸ヤ綔妗�
                     WrkMast wrkMast = wrkMastMapper.selectPakOutStep2(staProtocol.getSiteId());
                     if (wrkMast == null) {
@@ -846,7 +926,7 @@
             } else {
                 staProtocolIn = staProtocolIn.clone();
             }
-            int[] outStaNos = {1015, 2016};
+            int[] outStaNos = {1015, 2016}; //琛旀帴鍏ュ簱鐐�
             for (int outStaNo : outStaNos) {
                 StaProtocol staProtocolOut = devpThread.getStation().get(outStaNo);// 鐩樼偣鍑哄簱琛旀帴绔欑偣锛堝彲鑳芥槸 1015锛屼篃鍙兘鏄� 2016锛�
                 if (staProtocolOut == null) {
@@ -855,14 +935,17 @@
                     staProtocolOut = staProtocolOut.clone();
                 }
 
-                if (staProtocolOut.getWorkNo() != null && staProtocolOut.getStaNo() == 4006) {
-                    WrkMast wrkMastOut = wrkMastMapper.selectByWrkNo(staProtocolOut.getWorkNo());
+                WrkMast wrkMastOut = wrkMastMapper.selectByWrkNo(staProtocolOut.getWorkNo());
+                if(wrkMastOut == null ){
+                    continue;
+                }
+                if (staProtocolOut.getWorkNo() != null && wrkMastOut.getStaNo() == 4006) {
                     WrkMast wrkMast = wrkMastMapper.selectByWrkNo(9997);
                     if (wrkMastOut == null) {
                         continue;
                     }
                     if (wrkMast != null) {
-                        News.info("宸插瓨鍦ㄦ枩琛椾换鍔★紝绛夊緟浠诲姟瀹屾垚");
+//                        News.info("宸插瓨鍦ㄦ枩琛椾换鍔★紝绛夊緟浠诲姟瀹屾垚");
                         continue;
                     }
                     try {
@@ -895,7 +978,13 @@
                     }
                 }
             }
-            if(staProtocolIn.getWorkNo() != null &&staProtocolIn.getStaNo() != 4001){
+            if(staProtocolIn.getWorkNo() != null && staProtocolIn.getStaNo() != 4001){
+                WrkMast wrkMastCrn = wrkMastMapper.selectByWrkNo(staProtocolIn.getWorkNo());
+                if(wrkMastCrn!=null){
+                    if(wrkMastCrn.getCrnNo() == 3 ){
+                        continue;
+                    }
+                }
                 WrkMast wrkMastIn = wrkMastMapper.selectByWrkNo(staProtocolIn.getWorkNo());
                 WrkMast wrkMast = wrkMastMapper.selectByWrkNo(9996);
                 if(wrkMastIn == null){
@@ -1067,8 +1156,10 @@
             } else {
                 staProtocol = staProtocol.clone();
             }
-//            if (slave.getId() == 3) {
-//                SiemensDevpThread devpThread1 = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, crnStn.getDevpPlcId());
+//            WrkMast wrkMast9996 = wrkMastMapper.selectByWrkNo9996(9996);
+//
+//            if (slave.getId() == 3 && wrkMast9996 != null) {
+//                SiemensDevpThread devpThread1 = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp,2);
 //                StaProtocol staProtocol2 = devpThread1.getStation().get(4001);
 //                if (staProtocol2 == null) {
 //                    News.infoNoLog("" + mark + " - 2" + " - 3" + " - 鍫嗗灈鏈哄嚭搴撶珯淇℃伅(staProtocol!=null缁х画鎵ц,鍚﹀垯寰幆缁堟)锛歴taProtocol=" + staProtocol2);
@@ -1076,14 +1167,13 @@
 //                } else {
 //                    staProtocol2 = staProtocol2.clone();
 //                }
-//                WrkMast wrkMast9999 = wrkMastMapper.selectByWrkNo(9996);
 //                BasDevp staDetl = basDevpService.selectById(crnStn.getStaNo());
 //                if (staDetl == null) {
 //                    News.error(""+mark+" - 2"+" - 5"+" - 鍑哄簱 ===>> 鍫嗗灈鏈虹珯鐐瑰湪鏁版嵁搴撲笉瀛樺湪, 绔欑偣缂栧彿={}", crnStn.getStaNo());
 //                    break;
 ////                    continue;
 //                }
-//                if(wrkMast9999 != null && staProtocol2.isAutoing() && staDetl.getCanining() != null && staDetl.getCanining().equals("Y")){
+//                if( staProtocol2.isAutoing() && staProtocol2.isLoading() && staDetl.getCanining() != null && staDetl.getCanining().equals("Y")){
 //                    // 鍫嗗灈鏈烘帶鍒惰繃婊�
 //                    if (!crnProtocol.getStatusType().equals(CrnStatusType.IDLE) || crnProtocol.getTaskNo() != 0) {
 ////                        continue;
@@ -1100,23 +1190,30 @@
 //                    crnCommand.setTaskNo((short) 9996); // 宸ヤ綔鍙�
 ////                    crnCommand.setAckFinish((short) 0);  // 浠诲姟瀹屾垚纭浣�
 //                    crnCommand.setTaskMode(CrnTaskModeType.LOC_MOVE); // 浠诲姟妯″紡:  搴撲綅绉昏浆
-//                    crnCommand.setSourcePosX((short) 5);     // 婧愬簱浣嶆帓
-//                    crnCommand.setSourcePosY((short) 1);     // 婧愬簱浣嶅垪
-//                    crnCommand.setSourcePosZ((short) 4);     // 婧愬簱浣嶅眰
-//                    crnCommand.setDestinationPosX((short) 6);     // 鐩爣搴撲綅鎺�
-//                    crnCommand.setDestinationPosY((short) 1);     // 鐩爣搴撲綅鍒�
-//                    crnCommand.setDestinationPosZ((short) 1);     // 鐩爣搴撲綅灞�
+//                    crnCommand.setSourcePosX((short) 9);     // 婧愬簱浣嶆帓
+//                    crnCommand.setSourcePosY((short) 52);     // 婧愬簱浣嶅垪
+//                    crnCommand.setSourcePosZ((short) 3);     // 婧愬簱浣嶅眰
+//                    if(wrkMast9996.getStaNo()>2000){
+//                        crnCommand.setDestinationPosX((short) 9);     // 鐩爣搴撲綅鎺�
+//                        crnCommand.setDestinationPosY((short) 52);     // 鐩爣搴撲綅鍒�
+//                        crnCommand.setDestinationPosZ((short) 2);     // 鐩爣搴撲綅灞�
+//                    }else{
+//                        crnCommand.setDestinationPosX((short) 11);     // 鐩爣搴撲綅鎺�
+//                        crnCommand.setDestinationPosY((short) 52);     // 鐩爣搴撲綅鍒�
+//                        crnCommand.setDestinationPosZ((short) 1);     // 鐩爣搴撲綅灞�
+//                    }
+//
 ////                crnCommand.setTraySize(sourceSta.getLocType1() == 2);     //搴撲綅绫诲瀷
-//                    if (!MessageQueue.offer(SlaveType.Crn, wrkMast9999.getCrnNo(), new Task(2, crnCommand))) {
-//                        News.error("" + mark + " - 2" + " - 13" + " - 鍫嗗灈鏈哄懡浠や笅鍙戝け璐ワ紝鍫嗗灈鏈哄彿={}锛屼换鍔℃暟鎹�={}", wrkMast9999.getCrnNo(), JSON.toJSON(crnCommand));
+//                    if (!MessageQueue.offer(SlaveType.Crn, wrkMast9996.getCrnNo(), new Task(2, crnCommand))) {
+//                        News.error("" + mark + " - 2" + " - 13" + " - 鍫嗗灈鏈哄懡浠や笅鍙戝け璐ワ紝鍫嗗灈鏈哄彿={}锛屼换鍔℃暟鎹�={}", wrkMast9996.getCrnNo(), JSON.toJSON(crnCommand));
 //                    } else {
 //                        // 淇敼宸ヤ綔妗g姸鎬� 11.鐢熸垚鍑哄簱ID => 12.鍚婅溅鍑哄簱涓�
 //                        Date now = new Date();
-//                        wrkMast9999.setWrkSts(3L);
-//                        wrkMast9999.setCrnStrTime(now);
-//                        wrkMast9999.setModiTime(now);
-//                        if (wrkMastMapper.updateById(wrkMast9999) == 0) {
-//                            News.error("" + mark + " - 2" + " - 14" + " - 淇敼宸ヤ綔妗g姸鎬� 11.鐢熸垚鍑哄簱ID => 12.鍚婅溅鍑哄簱涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast9999.getWrkNo());
+//                        wrkMast9996.setWrkSts(3L);
+//                        wrkMast9996.setCrnStrTime(now);
+//                        wrkMast9996.setModiTime(now);
+//                        if (wrkMastMapper.updateById(wrkMast9996) == 0) {
+//                            News.error("" + mark + " - 2" + " - 14" + " - 淇敼宸ヤ綔妗g姸鎬� 11.鐢熸垚鍑哄簱ID => 12.鍚婅溅鍑哄簱涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast9996.getWrkNo());
 //                        }
 //                        break;
 //                    }
@@ -1266,8 +1363,12 @@
             // 鑾峰彇宸ヤ綔鐘舵�佷负11锛堢敓鎴愬嚭搴揑D锛夌殑鍑哄簱宸ヤ綔妗�
 //            WrkMast wrkMast = wrkMastMapper.selectPakOutStep1(slave.getId(), crnStn.getStaNo());
             List<WrkMast> wrkMasts = wrkMastMapper.selectPakOutStep11(slave.getId(), crnStn.getStaNo());
-            if (slave.getId() == 3) {
-                SiemensDevpThread devpThread1 = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, crnStn.getDevpPlcId());
+            WrkMast wrkMast9997 = wrkMastMapper.selectByWrkNo9997(9997);
+            WrkMast wrkMast9996 = wrkMastMapper.selectByWrkNo9997(9996);
+
+
+            if (slave.getId() == 3 && wrkMast9997 != null) {
+                SiemensDevpThread devpThread1 = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, 1);
                 StaProtocol staProtocol2 = devpThread1.getStation().get(1015);
                 if (staProtocol2 == null) {
                     News.infoNoLog("" + mark + " - 2" + " - 3" + " - 鍫嗗灈鏈哄嚭搴撶珯淇℃伅(staProtocol!=null缁х画鎵ц,鍚﹀垯寰幆缁堟)锛歴taProtocol=" + staProtocol2);
@@ -1275,14 +1376,21 @@
                 } else {
                     staProtocol2 = staProtocol2.clone();
                 }
-                WrkMast wrkMast9999 = wrkMastMapper.selectByWrkNo(9997);
+                SiemensDevpThread devpThread2 = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, 2);
+                StaProtocol staProtocol3 = devpThread2.getStation().get(2016);
+                if (staProtocol3 == null) {
+                    News.infoNoLog("" + mark + " - 2" + " - 3" + " - 鍫嗗灈鏈哄嚭搴撶珯淇℃伅(staProtocol!=null缁х画鎵ц,鍚﹀垯寰幆缁堟)锛歴taProtocol=" + staProtocol2);
+                    break;
+                } else {
+                    staProtocol3 = staProtocol3.clone();
+                }
                 BasDevp staDetl = basDevpService.selectById(crnStn.getStaNo());
                 if (staDetl == null) {
                     News.error(""+mark+" - 2"+" - 5"+" - 鍑哄簱 ===>> 鍫嗗灈鏈虹珯鐐瑰湪鏁版嵁搴撲笉瀛樺湪, 绔欑偣缂栧彿={}", crnStn.getStaNo());
                     break;
 //                    continue;
                 }
-                if(wrkMast9999 != null && staProtocol2.isAutoing() && staDetl.getCanouting() != null && staDetl.getCanouting().equals("Y")){
+                if(staProtocol2.isLoading() && staProtocol2.isAutoing() && staDetl.getCanouting() != null && staDetl.getCanouting().equals("Y")){
                     // 鍫嗗灈鏈烘帶鍒惰繃婊�
                     if (!crnProtocol.getStatusType().equals(CrnStatusType.IDLE) || crnProtocol.getTaskNo() != 0) {
 //                        continue;
@@ -1299,23 +1407,121 @@
                     crnCommand.setTaskNo((short) 9997); // 宸ヤ綔鍙�
 //                    crnCommand.setAckFinish((short) 0);  // 浠诲姟瀹屾垚纭浣�
                     crnCommand.setTaskMode(CrnTaskModeType.LOC_MOVE); // 浠诲姟妯″紡:  搴撲綅绉昏浆
-                    crnCommand.setSourcePosX((short) 5);     // 婧愬簱浣嶆帓
-                    crnCommand.setSourcePosY((short) 1);     // 婧愬簱浣嶅垪
+                    crnCommand.setSourcePosX((short) 9);     // 婧愬簱浣嶆帓
+                    crnCommand.setSourcePosY((short) 52);     // 婧愬簱浣嶅垪
                     crnCommand.setSourcePosZ((short) 1);     // 婧愬簱浣嶅眰
-                    crnCommand.setDestinationPosX((short) 6);     // 鐩爣搴撲綅鎺�
-                    crnCommand.setDestinationPosY((short) 1);     // 鐩爣搴撲綅鍒�
-                    crnCommand.setDestinationPosZ((short) 4);     // 鐩爣搴撲綅灞�
+                    crnCommand.setDestinationPosX((short) 11);     // 鐩爣搴撲綅鎺�
+                    crnCommand.setDestinationPosY((short) 52);     // 鐩爣搴撲綅鍒�
+                    crnCommand.setDestinationPosZ((short) 3);     // 鐩爣搴撲綅灞�
 //                crnCommand.setTraySize(sourceSta.getLocType1() == 2);     //搴撲綅绫诲瀷
-                    if (!MessageQueue.offer(SlaveType.Crn, wrkMast9999.getCrnNo(), new Task(2, crnCommand))) {
-                        News.error("" + mark + " - 2" + " - 13" + " - 鍫嗗灈鏈哄懡浠や笅鍙戝け璐ワ紝鍫嗗灈鏈哄彿={}锛屼换鍔℃暟鎹�={}", wrkMast9999.getCrnNo(), JSON.toJSON(crnCommand));
+                    if (!MessageQueue.offer(SlaveType.Crn, wrkMast9997.getCrnNo(), new Task(2, crnCommand))) {
+                        News.error("" + mark + " - 2" + " - 13" + " - 鍫嗗灈鏈哄懡浠や笅鍙戝け璐ワ紝鍫嗗灈鏈哄彿={}锛屼换鍔℃暟鎹�={}", wrkMast9997.getCrnNo(), JSON.toJSON(crnCommand));
                     } else {
                         // 淇敼宸ヤ綔妗g姸鎬� 11.鐢熸垚鍑哄簱ID => 12.鍚婅溅鍑哄簱涓�
                         Date now = new Date();
-                        wrkMast9999.setWrkSts(12L);
-                        wrkMast9999.setCrnStrTime(now);
-                        wrkMast9999.setModiTime(now);
-                        if (wrkMastMapper.updateById(wrkMast9999) == 0) {
-                            News.error("" + mark + " - 2" + " - 14" + " - 淇敼宸ヤ綔妗g姸鎬� 11.鐢熸垚鍑哄簱ID => 12.鍚婅溅鍑哄簱涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast9999.getWrkNo());
+                        wrkMast9997.setWrkSts(12L);
+                        wrkMast9997.setCrnStrTime(now);
+                        wrkMast9997.setModiTime(now);
+                        if (wrkMastMapper.updateById(wrkMast9997) == 0) {
+                            News.error("" + mark + " - 2" + " - 14" + " - 淇敼宸ヤ綔妗g姸鎬� 11.鐢熸垚鍑哄簱ID => 12.鍚婅溅鍑哄簱涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast9997.getWrkNo());
+                        }
+                        break;
+                    }
+                }
+                if(staProtocol3.isLoading() && staProtocol3.isAutoing()){
+                    // 鍫嗗灈鏈烘帶鍒惰繃婊�
+                    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((short) 9997); // 宸ヤ綔鍙�
+//                    crnCommand.setAckFinish((short) 0);  // 浠诲姟瀹屾垚纭浣�
+                    crnCommand.setTaskMode(CrnTaskModeType.LOC_MOVE); // 浠诲姟妯″紡:  搴撲綅绉昏浆
+                    crnCommand.setSourcePosX((short) 11);     // 婧愬簱浣嶆帓
+                    crnCommand.setSourcePosY((short) 52);     // 婧愬簱浣嶅垪
+                    crnCommand.setSourcePosZ((short) 2);     // 婧愬簱浣嶅眰
+                    crnCommand.setDestinationPosX((short) 11);     // 鐩爣搴撲綅鎺�
+                    crnCommand.setDestinationPosY((short) 52);     // 鐩爣搴撲綅鍒�
+                    crnCommand.setDestinationPosZ((short) 3);     // 鐩爣搴撲綅灞�
+//                crnCommand.setTraySize(sourceSta.getLocType1() == 2);     //搴撲綅绫诲瀷
+                    if (!MessageQueue.offer(SlaveType.Crn, wrkMast9997.getCrnNo(), new Task(2, crnCommand))) {
+                        News.error("" + mark + " - 2" + " - 13" + " - 鍫嗗灈鏈哄懡浠や笅鍙戝け璐ワ紝鍫嗗灈鏈哄彿={}锛屼换鍔℃暟鎹�={}", wrkMast9997.getCrnNo(), JSON.toJSON(crnCommand));
+                    } else {
+                        // 淇敼宸ヤ綔妗g姸鎬� 11.鐢熸垚鍑哄簱ID => 12.鍚婅溅鍑哄簱涓�
+                        Date now = new Date();
+                        wrkMast9997.setWrkSts(12L);
+                        wrkMast9997.setCrnStrTime(now);
+                        wrkMast9997.setModiTime(now);
+                        if (wrkMastMapper.updateById(wrkMast9997) == 0) {
+                            News.error("" + mark + " - 2" + " - 14" + " - 淇敼宸ヤ綔妗g姸鎬� 11.鐢熸垚鍑哄簱ID => 12.鍚婅溅鍑哄簱涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast9997.getWrkNo());
+                        }
+                        break;
+                    }
+                }
+            }
+            if (slave.getId() == 3 && wrkMast9996 != null) {
+                SiemensDevpThread devpThread2 = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, 2);
+                StaProtocol staProtocol4001 = devpThread2.getStation().get(4001);
+                if (staProtocol4001 == null) {
+                    News.infoNoLog("" + mark + " - 2" + " - 3" + " - 鍫嗗灈鏈哄嚭搴撶珯淇℃伅(staProtocol!=null缁х画鎵ц,鍚﹀垯寰幆缁堟)锛歴taProtocol=" + staProtocol4001);
+                    break;
+                } else {
+                    staProtocol4001 = staProtocol4001.clone();
+                }
+                BasDevp staDetl = basDevpService.selectById(crnStn.getStaNo());
+                if (staDetl == null) {
+                    News.error(""+mark+" - 2"+" - 5"+" - 鍑哄簱 ===>> 鍫嗗灈鏈虹珯鐐瑰湪鏁版嵁搴撲笉瀛樺湪, 绔欑偣缂栧彿={}", crnStn.getStaNo());
+                    break;
+//                    continue;
+                }
+                if(staProtocol4001.isLoading() && staProtocol4001.isAutoing() && staDetl.getCanouting() != null && staDetl.getCanouting().equals("Y")){
+                    // 鍫嗗灈鏈烘帶鍒惰繃婊�
+                    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((short) 9996); // 宸ヤ綔鍙�
+//                    crnCommand.setAckFinish((short) 0);  // 浠诲姟瀹屾垚纭浣�
+                    crnCommand.setTaskMode(CrnTaskModeType.LOC_MOVE); // 浠诲姟妯″紡:  搴撲綅绉昏浆
+                    crnCommand.setSourcePosX((short) 9);     // 婧愬簱浣嶆帓
+                    crnCommand.setSourcePosY((short) 52);     // 婧愬簱浣嶅垪
+                    crnCommand.setSourcePosZ((short) 3);     // 婧愬簱浣嶅眰
+                    if(wrkMast9996.getStaNo()>2000){
+                        crnCommand.setDestinationPosX((short) 9);     // 鐩爣搴撲綅鎺�
+                        crnCommand.setDestinationPosY((short) 52);     // 鐩爣搴撲綅鍒�
+                        crnCommand.setDestinationPosZ((short) 2);     // 鐩爣搴撲綅灞�
+                    }else{
+                        crnCommand.setDestinationPosX((short) 11);     // 鐩爣搴撲綅鎺�
+                        crnCommand.setDestinationPosY((short) 52);     // 鐩爣搴撲綅鍒�
+                        crnCommand.setDestinationPosZ((short) 1);     // 鐩爣搴撲綅灞�
+                    }
+//                crnCommand.setTraySize(sourceSta.getLocType1() == 2);     //搴撲綅绫诲瀷
+                    if (!MessageQueue.offer(SlaveType.Crn, wrkMast9996.getCrnNo(), new Task(2, crnCommand))) {
+                        News.error("" + mark + " - 2" + " - 13" + " - 鍫嗗灈鏈哄懡浠や笅鍙戝け璐ワ紝鍫嗗灈鏈哄彿={}锛屼换鍔℃暟鎹�={}", wrkMast9996.getCrnNo(), JSON.toJSON(crnCommand));
+                    } else {
+                        // 淇敼宸ヤ綔妗g姸鎬� 11.鐢熸垚鍑哄簱ID => 12.鍚婅溅鍑哄簱涓�
+                        Date now = new Date();
+                        wrkMast9996.setWrkSts(12L);
+                        wrkMast9996.setCrnStrTime(now);
+                        wrkMast9996.setModiTime(now);
+                        if (wrkMastMapper.updateById(wrkMast9996) == 0) {
+                            News.error("" + mark + " - 2" + " - 14" + " - 淇敼宸ヤ綔妗g姸鎬� 11.鐢熸垚鍑哄簱ID => 12.鍚婅溅鍑哄簱涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast9996.getWrkNo());
                         }
                         break;
                     }
@@ -2581,18 +2787,18 @@
     public synchronized void autoEmptyOut() {
         SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, 1);
         List<Integer> list = new ArrayList<>();
-        list.add(1109);list.add(2031);
+        list.add(1108);list.add(2031);
         for (Integer site:list){
             Integer emptyCount = wrkMastMapper.countPakOutEmpty(site);
             StaProtocol staProtocol = null;
-            if(emptyCount >= 2 && site == 1109){
+            if(emptyCount >= 1 && site == 1108){
                 continue;
             }else if(emptyCount == 1 && site == 2031){
                 continue;
             }
             //濡傛灉绔欑偣鍙嚭绂佺敤锛屽垯涓嶇敓鎴愮┖鐩樺嚭搴撲换鍔�
             switch (site){
-                case 1109:staProtocol = devpThread.getStation().get(site - 2);break;
+                case 1108:staProtocol = devpThread.getStation().get(site - 2);break;
                 case 2031:staProtocol = devpThread.getStation().get(site);break;
             }
             if (staProtocol == null) {
@@ -2602,7 +2808,7 @@
             }
             if (staProtocol.isAutoing()  //鑷姩
                     && !staProtocol.isLoading()  //鏃犵墿
-                    && staProtocol.isOutEnable()  //鍙嚭淇″彿
+//                    && staProtocol.isOutEnable()  //鍙嚭淇″彿
                     && staProtocol.getWorkNo() == 0
             ) {
                 Short loctype1 = 1;
@@ -3352,7 +3558,7 @@
             if(wrkMastSta1 != null && wrkMastSta2 != null){
                 rgvThread.setPakMk(false);  //灏忚溅鍙屽伐浣嶉攣瀹�
             }
-//            if(!rgvThread.isPakToCrn()){
+//            if(basRgv.getPakToCrn().equals("0")){
 //                rgvRunWrkToCrn(rgv, rgvProtocol,mark); //鑻ュ皬杞﹀彇鍒颁竴涓帴椹充换鍔★紝绗簩涓伐浣嶅彧鑳藉彇鎺ラ┏浠诲姟
 //            }
 //            if(rgvProtocol.getStatusType1() == RgvStatusType.IDLE && rgvProtocol.getTaskNo1() == 0 && rgvThread.isPakIn() && rgvThread.isPakRgv()){
@@ -3607,6 +3813,9 @@
                 continue;
             }
             WrkMastSta wrkMastSta1 = wrkMastStaMapper.selectByWrkNo( rgvProtocol.getTaskNo1());
+            if(basRgv.getPakToCrn().equals("0")){
+                wrkMastSta = wrkMastStaMapper.selectNoInterfereCrn(route, route, Long.valueOf(staProtocol.getWorkNo()));
+            }
             boolean result = false;
             if(wrkMastSta1!= null && rgvProtocol.getRgvNo() == 1){ //璺濈璁$畻   2妤煎崟鍏ュ簱鍙d笉闇�瑕佽绠�
                 result = rgvCalcDistance((int) rgvProtocol.getRgvNo(),wrkMastSta1.getStaEnd(),wrkMastSta.getStaStart());//宸ヤ綅2鏀捐揣绔欑偣锛屽伐浣�1鍙栬揣绔欑偣
@@ -3615,7 +3824,6 @@
                 basRgv.setPakRgv("0");
                 basRgvService.updateById(basRgv);
 
-//                rgvThread.setPakRgv(false);
                 continue;
             }
             wrkMastSta.setWorkSta(wrkMastSta1 !=null ? 2 : 1);//鑻�1鍙峰伐浣嶆湁浠诲姟缁�2鍙峰伐浣�
@@ -3626,8 +3834,11 @@
                 if(LEFT_POSITION.contains(wrkMastSta.getStaEnd())){
                     basRgv.setPakToCrn("0");
                     basRgvService.updateById(basRgv);
-
-//                    rgvThread.setPakToCrn(false); //閿佸畾灏忚溅鍙兘鎺ユ帴椹充换鍔�
+                    if(wrkMastSta3 != null){
+                        if(!LEFT_POSITION.contains(wrkMastSta3.getStaEnd())){
+                            wrkMastSta3 = null;//鑻ユ帴椹崇浜屼綅涓嶆帴椹虫椂鍙栨秷杩炵画鍙栬揣
+                        }
+                    }
                 }
 
                 if(wrkMastSta3 != null ){
@@ -3667,94 +3878,137 @@
     /**
      * 灏忚溅鍑哄簱鎺ラ┏浠诲姟鍙栬揣涓嬪彂
      */
-//    public synchronized void rgvRunWrkToCrn(RgvSlave slave, RgvProtocol rgvProtocol,Integer mark){
-//        for (RgvSlave.RgvStn rgvStn : slave.getRgvOutTStn()) {//rgv鍑哄簱鍙栬揣绔欑偣
-//            boolean flag = false;
-//            //閬嶅巻rgv鍏ュ簱鍙栬揣绔欑偣
-//            DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, rgvStn.getDevpPlcId());
-//            StaProtocol staProtocol = devpThread.getStation().get(rgvStn.getStaNo());
-//            RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, (int) rgvProtocol.getRgvNo());
-//            StaProtocol staProtocol2 = null;
-//            if(rgvStn.getStaNo2()!= null ){
-//                staProtocol2 = devpThread.getStation().get(rgvStn.getStaNo2());
-//                if (staProtocol2 == null) {
-//                    News.infoNoLog("" + mark + " - 1" + " - 1" + " - Rgv鍏ュ簱绔欎俊鎭�(staProtocol!=null缁х画鎵ц)锛歴taProtocol=" + staProtocol);
-//                    continue;
-//                } else {
-//                    staProtocol2 = staProtocol2.clone();
-//                }
-//                BasDevp staDetl2 = basDevpService.selectById(rgvStn.getStaNo2());
-//                if (staDetl2 == null) {
-//                    News.error("" + mark + " - 1" + " - 2" + " - 鍏ュ簱 ===>>Rgv绔欑偣鍦ㄦ暟鎹簱涓嶅瓨鍦�, 绔欑偣缂栧彿={}", rgvStn.getStaNo());
-//                    continue;
-//                }
-//            }
-//            if (staProtocol == null) {
-//                News.infoNoLog("" + mark + " - 1" + " - 1" + " - Rgv鍑哄簱绔欎俊鎭�(staProtocol!=null缁х画鎵ц)锛歴taProtocol=" + staProtocol);
-//                continue;
-//            } else {
-//                staProtocol = staProtocol.clone();
-//            }
-//
-//            // 鏌ヨ绔欑偣璇︾粏淇℃伅
-//            BasDevp staDetl = basDevpService.selectById(rgvStn.getStaNo());
-//            if (staDetl == null) {
-//                News.error("" + mark + " - 1" + " - 2" + " - 鍑哄簱 ===>>Rgv绔欑偣鍦ㄦ暟鎹簱涓嶅瓨鍦�, 绔欑偣缂栧彿={}", rgvStn.getStaNo());
-//                continue;
-//            }
-//
-//            if (staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.getWorkNo() > 0
-//                    && staDetl.getCanouting() != null && staDetl.getCanouting().equals("Y")) {
-//                flag = true;
-//            }
-//            if (!flag) {
-//                News.errorNoLog("" + mark + " - 1" + " - 3" + " - Rgv鍑哄簱鍙栬揣绔欎俊鎭�(浠ヤ笅闇�瑕佸叏true):"
-//                        + "鑷姩淇″彿" + staProtocol.isAutoing() + "鏈夌墿淇″彿" + staProtocol.isLoading()
-//                        + "宸ヤ綔鍙�>0" + staProtocol.getWorkNo() + "鍙叆淇″彿" + staProtocol.isOutEnable()
-//                        + "鑳藉叆淇″彿锛坵ms璁剧疆锛�.equals(\"Y\")" + staDetl.getCanouting());
-//                continue;
-//            }
-//            BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
-//            List<Integer> route = new ArrayList<>();
-//            switch (rgvProtocol.getRgvNo()){
-//                case 1: route = RouteUtils.getRouteOne();break;
-//                case 2: route = RouteUtils.getRouteTwo();break;
-//            }
-//            basRgvMap.setNowRoute(rgvProtocol.getRgvPosI2()); //鏇存柊灏忚溅褰撳墠浣嶇疆绔欑偣鍙�
-//            WrkMastSta wrkMastSta = wrkMastStaMapper.selectNoInterfereToCrn(route, route, Long.valueOf(staProtocol.getWorkNo()));//鏍规嵁绔欑偣宸ヤ綔鍙峰拰灏忚溅宸ヤ綔鑼冨洿妫�绱换鍔℃。
-//            if( null == wrkMastSta ) {
-//                News.infoNoLog("" + mark + " - 1" + " - 4" + " - 鏌ヨ鏃犲緟鍏ュ簱鏁版嵁--wrk_sts0, 宸ヤ綔鍙�={}", staProtocol.getWorkNo());
-//                continue;
-//            }
-//            WrkMastSta wrkMastSta1 = wrkMastStaMapper.selectByWrkNo( rgvProtocol.getTaskNo1());
-//            boolean result = false;
-//            if(wrkMastSta1!= null && rgvProtocol.getRgvNo() == 1){ //璺濈璁$畻   2妤煎崟鍏ュ簱鍙d笉闇�瑕佽绠�
-//                result = rgvCalcDistance((int) rgvProtocol.getRgvNo(),wrkMastSta1.getStaEnd(),wrkMastSta.getStaStart());//宸ヤ綅2鏀捐揣绔欑偣锛屽伐浣�1鍙栬揣绔欑偣
-//            }
-//            if(result){//鑻ュ皬杞﹁窛绂绘斁璐х偣璺濈杩戜簬鍙栬揣鐐瑰垯璺宠繃鍙栬揣 true璺宠繃鍙栬揣/false浼樺厛鍙栬揣
-//                rgvThread.setPakRgv(false);
-//                continue;
-//            }
-//            wrkMastSta.setWorkSta(wrkMastSta1 !=null ? 2 : 1);//鑻�1鍙峰伐浣嶆湁浠诲姟缁�2鍙峰伐浣�
-//            wrkMastSta.setRgvNo((int) rgvProtocol.getRgvNo());
-//            boolean sign = false;
-//            sign = rgvTakeFullAll(basRgvMap.getRgvNo(), wrkMastSta); //鍛戒护涓嬪彂
-//            if (sign){
+    public synchronized void rgvRunWrkToCrn(RgvSlave slave, RgvProtocol rgvProtocol,Integer mark){
+        for (RgvSlave.RgvStn rgvStn : slave.getRgvOutTStn()) {//rgv鍑哄簱鍙栬揣绔欑偣
+            boolean flag = false;
+            //閬嶅巻rgv鍏ュ簱鍙栬揣绔欑偣
+            DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, rgvStn.getDevpPlcId());
+            StaProtocol staProtocol = devpThread.getStation().get(rgvStn.getStaNo());
+            RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, (int) rgvProtocol.getRgvNo());
+            BasRgv basRgv = basRgvService.selectById(slave.getId());
+            if (basRgv == null) {
+                log.error("{}鍙稲GV灏氭湭鍦ㄦ暟鎹簱杩涜缁存姢锛�4", slave.getId());
+                continue;
+            }
+            StaProtocol staProtocol2 = null;
+            WrkMastSta wrkMastSta3 = null;
+
+            if(rgvStn.getStaNo2()!= null ){
+                staProtocol2 = devpThread.getStation().get(rgvStn.getStaNo2());
+                if (staProtocol2 == null) {
+                    News.infoNoLog("" + mark + " - 1" + " - 1" + " - Rgv鍏ュ簱绔欎俊鎭�(staProtocol!=null缁х画鎵ц)锛歴taProtocol=" + staProtocol);
+                    continue;
+                } else {
+                    staProtocol2 = staProtocol2.clone();
+                }
+                BasDevp staDetl2 = basDevpService.selectById(rgvStn.getStaNo2());
+                if (staDetl2 == null) {
+                    News.error("" + mark + " - 1" + " - 2" + " - 鍏ュ簱 ===>>Rgv绔欑偣鍦ㄦ暟鎹簱涓嶅瓨鍦�, 绔欑偣缂栧彿={}", rgvStn.getStaNo());
+                    continue;
+                }
+                wrkMastSta3 = wrkMastStaMapper.selectByWrkNo(staProtocol2.getWorkNo());
+
+            }
+            if (staProtocol == null) {
+                News.infoNoLog("" + mark + " - 1" + " - 1" + " - Rgv鍑哄簱绔欎俊鎭�(staProtocol!=null缁х画鎵ц)锛歴taProtocol=" + staProtocol);
+                continue;
+            } else {
+                staProtocol = staProtocol.clone();
+            }
+
+            // 鏌ヨ绔欑偣璇︾粏淇℃伅
+            BasDevp staDetl = basDevpService.selectById(rgvStn.getStaNo());
+            if (staDetl == null) {
+                News.error("" + mark + " - 1" + " - 2" + " - 鍑哄簱 ===>>Rgv绔欑偣鍦ㄦ暟鎹簱涓嶅瓨鍦�, 绔欑偣缂栧彿={}", rgvStn.getStaNo());
+                continue;
+            }
+
+            if (staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.getWorkNo() > 0
+                    && staDetl.getCanouting() != null && staDetl.getCanouting().equals("Y")) {
+                flag = true;
+            }
+            if (!flag) {
+                News.errorNoLog("" + mark + " - 1" + " - 3" + " - Rgv鍑哄簱鍙栬揣绔欎俊鎭�(浠ヤ笅闇�瑕佸叏true):"
+                        + "鑷姩淇″彿" + staProtocol.isAutoing() + "鏈夌墿淇″彿" + staProtocol.isLoading()
+                        + "宸ヤ綔鍙�>0" + staProtocol.getWorkNo() + "鍙叆淇″彿" + staProtocol.isOutEnable()
+                        + "鑳藉叆淇″彿锛坵ms璁剧疆锛�.equals(\"Y\")" + staDetl.getCanouting());
+                continue;
+            }
+            BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
+            List<Integer> route = new ArrayList<>();
+            switch (rgvProtocol.getRgvNo()){
+                case 1: route = RouteUtils.getRouteOne();break;
+                case 2: route = RouteUtils.getRouteTwo();break;
+            }
+            basRgvMap.setNowRoute(rgvProtocol.getRgvPosI2()); //鏇存柊灏忚溅褰撳墠浣嶇疆绔欑偣鍙�
+            basRgvMapService.updateById(basRgvMap);
+            WrkMastSta wrkMastSta = wrkMastStaMapper.selectNoInterfere(route, route, Long.valueOf(staProtocol.getWorkNo()));//鏍规嵁绔欑偣宸ヤ綔鍙峰拰灏忚溅宸ヤ綔鑼冨洿妫�绱换鍔℃。
+            if( null == wrkMastSta ) {
+                News.infoNoLog("" + mark + " - 1" + " - 4" + " - 鏌ヨ鏃犲緟鍏ュ簱鏁版嵁--wrk_sts0, 宸ヤ綔鍙�={}", staProtocol.getWorkNo());
+                continue;
+            }
+            WrkMastSta wrkMastSta1 = wrkMastStaMapper.selectByWrkNo( rgvProtocol.getTaskNo1());
+            if(basRgv.getPakToCrn().equals("0")){
+                wrkMastSta = wrkMastStaMapper.selectNoInterfereCrn(route, route, Long.valueOf(staProtocol.getWorkNo()));
+            }
+            boolean result = false;
+            if(wrkMastSta1!= null && rgvProtocol.getRgvNo() == 1){ //璺濈璁$畻   2妤煎崟鍏ュ簱鍙d笉闇�瑕佽绠�
+                result = rgvCalcDistance((int) rgvProtocol.getRgvNo(),wrkMastSta1.getStaEnd(),wrkMastSta.getStaStart());//宸ヤ綅2鏀捐揣绔欑偣锛屽伐浣�1鍙栬揣绔欑偣
+            }
+            if(result){//鑻ュ皬杞﹁窛绂绘斁璐х偣璺濈杩戜簬鍙栬揣鐐瑰垯璺宠繃鍙栬揣 true璺宠繃鍙栬揣/false浼樺厛鍙栬揣
+                basRgv.setPakRgv("0");
+                basRgvService.updateById(basRgv);
+
+                continue;
+            }
+            wrkMastSta.setWorkSta(wrkMastSta1 !=null ? 2 : 1);//鑻�1鍙峰伐浣嶆湁浠诲姟缁�2鍙峰伐浣�
+            wrkMastSta.setRgvNo((int) rgvProtocol.getRgvNo());
+            boolean sign = false;
+            sign = rgvTakeFullAll(basRgvMap.getRgvNo(), wrkMastSta); //鍛戒护涓嬪彂
+            if (sign){
+                if(LEFT_POSITION.contains(wrkMastSta.getStaEnd())){
+                    basRgv.setPakToCrn("0");
+                    basRgvService.updateById(basRgv);
+                    if(wrkMastSta3 != null){
+                        if(!LEFT_POSITION.contains(wrkMastSta3.getStaEnd())){
+                            wrkMastSta3 = null;//鑻ユ帴椹崇浜屼綅涓嶆帴椹虫椂鍙栨秷杩炵画鍙栬揣
+                        }
+                    }
+                }
+
+                if(wrkMastSta3 != null ){
+                    List<WrkMastSta> wrkMastStaPaking = wrkMastStaService.selectPakingWrk(wrkMastSta3.getStaStart());
+                    if(wrkMastStaPaking.size() < 1){
+                        wrkMastSta3.setMk(1);
+                        basRgv.setPakAll("0");
+                        basRgvService.updateById(basRgv);
+                        try{
+                            wrkMastStaMapper.updateById(wrkMastSta3);
+                            log.error("閿佸畾鐩搁殧绔欑偣浠诲姟");
+                        }catch (Exception e){
+                            log.error("閿佸畾鐩搁殧绔欑偣浠诲姟澶辫触");
+                        }
+                    }
+                }
+                basRgv.setPakIn("0");
+                basRgvService.updateById(basRgv);
+
+                rgvThread.setPaking(false);
 //                rgvThread.setPakIn(false);//鍏ュ簱涓嶅厑璁�
-//                try{
-//                    wrkMastSta.setWrkSts(1);
-//                    wrkMastStaMapper.updateById(wrkMastSta);
-//                    log.error("鏇存柊灏忚溅浠诲姟鎴愬姛");
-//                }catch (Exception e){
-//                    log.error("鏇存柊灏忚溅浠诲姟澶辫触");
-//                }
-//            } else {
-//                log.error("宸ヤ綔鍙穥}鎵�灞炰换鍔′笅鍙戝け璐�",wrkMastSta.getWrkNo());
-//            }
-//
-//
-//        }
-//    }
+                try{
+                    wrkMastSta.setWrkSts(1);
+                    wrkMastStaMapper.updateById(wrkMastSta);
+                    log.error("鏇存柊灏忚溅浠诲姟鎴愬姛");
+                }catch (Exception e){
+                    log.error("鏇存柊灏忚溅浠诲姟澶辫触");
+                }
+            } else {
+                log.error("宸ヤ綔鍙穥}鎵�灞炰换鍔′笅鍙戝け璐�",wrkMastSta.getWrkNo());
+            }
+
+
+        }
+    }
     /**
      * 鎵ц灏忚溅鎼繍浠诲姟
      *
@@ -4240,7 +4494,9 @@
                     List<BasArmMast> basArmMastListRuning3 = basArmMastService.selectList(
                             new EntityWrapper<BasArmMast>()
                                     .eq("arm_no", basArm.getArmNo())
-                                    .eq("sorting_line", basArm.getSortingLineSou())
+                                    .eq(
+
+                                            "sorting_line", basArm.getSortingLineSou())
                                     .eq("status", 3)
                     );
                     if (basArmMastListRuning.isEmpty() && basArmMastListRuning3.isEmpty()){
@@ -4269,6 +4525,24 @@
                                         .eq("binding_tags", basArmMast.getBindingTags())
                         );
                         if (basArmMastListOrder.size()==1){
+                            Thread.sleep(100);
+
+
+                            List<BasArmMast> basArmMastListRuningBarCode2 = basArmMastService.selectList(
+                                    new EntityWrapper<BasArmMast>()
+                                            .eq("barcode", barcode)
+                            );
+                            if (!basArmMastListRuningBarCode2.isEmpty()){
+                                int binding_tags = basArmMastService.selectCount(
+                                        new EntityWrapper<BasArmMast>()
+                                                .eq("status", 2)
+                                                .eq("binding_tags", basArmMast.getBindingTags())
+                                );
+                                if (binding_tags<2){
+                                    armTaskAssignmentCallApiLogSave(staProtocol, "鏉$爜鏁版嵁宸插瓨鍦紒锛侊紒", staProtocol.getSiteId()+"鐮佸灈浣嶇疆锛屾潯鐮佹暟鎹鍦ㄨ嚜鍔ㄧ粍鎵�===>>" + barcode, false);
+                                    continue;
+                                }
+                            }
                             OrderDetlValueResultUtil orderDetlValueResultUtil = basArmMastService.selectOrderDetlValue(basArmMast.getOrderNo(), basArmMast.getSku());
 
                             if (Cools.isEmpty(orderDetlValueResultUtil)){
@@ -4339,4 +4613,189 @@
                 response, bool);
     }
 
+    /*
+     * agv浠诲姟涓嬪彂:AGV搴撲綅==銆嬭緭閫佺嚎绔欑偣
+     * */
+    public synchronized void agvTaskAssignment0() {
+        try{
+            List<BasAgvMast> basAgvMastList = basAgvMastService.selectList(new EntityWrapper<BasAgvMast>().eq("status", 0));
+            for (BasAgvMast basAgvMast : basAgvMastList) {
+                if (basAgvMast.getStatus()!=0 && basAgvMast.getIoType()!=0){//0==銆婣GV搴撲綅==銆嬭緭閫佺嚎绔欑偣
+                    continue;
+                }
+                try{
+                    // 鑾峰彇绔欑偣淇℃伅
+                    SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, basAgvMast.getDevpId());
+                    StaProtocol staProtocol = devpThread.getStation().get(basAgvMast.getStaNo());
+                    if (staProtocol == null) {
+                        continue;
+                    } else {
+                        staProtocol = staProtocol.clone();
+                    }
+
+                    if (staProtocol.isAutoing()){
+
+                        AgvTaskAssignmentParam agvTaskAssignmentParam = new AgvTaskAssignmentParam(basAgvMast);
+
+                        //浠诲姟涓嬪彂
+                        ReturnT<String> result = new PostMesDataUtils().postMesData("AGV浠诲姟涓嬪彂", AgvConstant.AGV_URL, AgvConstant.AGV_ADAPTOR, agvTaskAssignmentParam);
+                        if (result.getCode()==200){
+                            basAgvMast.setStatus(1);
+                            basAgvMastService.updateById(basAgvMast);
+                        } else {
+                            agvTaskAssignmentCallApiLogSave(basAgvMast, "AGV浠诲姟涓嬪彂澶辫触", "浠诲姟鍙凤細"+basAgvMast.getTaskNo()+"浠诲姟淇℃伅涓嬪彂澶辫触锛侊紒锛�", false);
+                        }
+                    }
+                }  catch (Exception e){
+                    log.error("浠诲姟鍙凤細"+basAgvMast.getTaskNo()+"====銆婣GV浠诲姟涓嬪彂澶辫触"+e.getMessage());
+                }
+            }
+        }catch (Exception e){
+            log.error("AGV浠诲姟涓嬪彂澶辫触"+e.getMessage());
+        }
+    }
+
+    /*
+     * agv浠诲姟涓嬪彂:AGV搴撲綅==銆婣GV搴撲綅
+     * */
+    public synchronized void agvTaskAssignment1() {
+        try{
+            List<BasAgvMast> basAgvMastList = basAgvMastService.selectList(new EntityWrapper<BasAgvMast>().eq("status", 0));
+            for (BasAgvMast basAgvMast : basAgvMastList) {
+                if (basAgvMast.getStatus()!=0 && basAgvMast.getIoType()!=1){//1==銆婣GV搴撲綅==銆婣GV搴撲綅
+                    continue;
+                }
+                try{
+                    AgvTaskAssignmentParam agvTaskAssignmentParam = new AgvTaskAssignmentParam();
+
+                    //浠诲姟涓嬪彂
+                    ReturnT<String> result = new PostMesDataUtils().postMesData("AGV浠诲姟涓嬪彂", AgvConstant.AGV_URL, AgvConstant.AGV_ADAPTOR, agvTaskAssignmentParam);
+                    if (result.getCode()==200){
+                        basAgvMast.setStatus(1);
+                        basAgvMastService.updateById(basAgvMast);
+                    } else {
+                        agvTaskAssignmentCallApiLogSave(basAgvMast, "AGV浠诲姟涓嬪彂澶辫触", "浠诲姟鍙凤細"+basAgvMast.getTaskNo()+"浠诲姟淇℃伅涓嬪彂澶辫触锛侊紒锛�", false);
+                    }
+
+                }  catch (Exception e){
+                    log.error("浠诲姟鍙凤細"+basAgvMast.getTaskNo()+"====銆婣GV浠诲姟涓嬪彂澶辫触"+e.getMessage());
+                }
+            }
+        }catch (Exception e){
+            log.error("AGV浠诲姟涓嬪彂澶辫触"+e.getMessage());
+        }
+    }
+
+    /*
+     * agv浠诲姟涓嬪彂:杈撻�佺嚎绔欑偣==銆婣GV搴撲綅
+     * */
+    public synchronized void agvTaskAssignment2() {
+        try{
+            List<BasAgvMast> basAgvMastList = basAgvMastService.selectList(new EntityWrapper<BasAgvMast>().eq("status", 0));
+            for (BasAgvMast basAgvMast : basAgvMastList) {
+                if (basAgvMast.getStatus()!=0 && basAgvMast.getIoType()!=2){//2==銆嬭緭閫佺嚎绔欑偣==銆婣GV搴撲綅
+                    continue;
+                }
+                try{
+                    // 鑾峰彇绔欑偣淇℃伅
+                    SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, basAgvMast.getDevpId());
+                    StaProtocol staProtocol = devpThread.getStation().get(basAgvMast.getSourceStaNo());
+                    if (staProtocol == null || !staProtocol.isLoading()) {
+                        continue;
+                    } else {
+                        staProtocol = staProtocol.clone();
+                    }
+
+                    if (!Cools.isEmpty(staProtocol.getWorkNo()) && staProtocol.getWorkNo().equals(basAgvMast.getTaskNo())){
+
+                        AgvTaskAssignmentParam agvTaskAssignmentParam = new AgvTaskAssignmentParam();
+
+                        //浠诲姟涓嬪彂
+                        ReturnT<String> result = new PostMesDataUtils().postMesData("AGV浠诲姟涓嬪彂", AgvConstant.AGV_URL, AgvConstant.AGV_ADAPTOR, agvTaskAssignmentParam);
+                        if (result.getCode()==200){
+                            basAgvMast.setStatus(1);
+                            basAgvMastService.updateById(basAgvMast);
+                        } else {
+                            agvTaskAssignmentCallApiLogSave(basAgvMast, "AGV浠诲姟涓嬪彂澶辫触", "浠诲姟鍙凤細"+basAgvMast.getTaskNo()+"浠诲姟淇℃伅涓嬪彂澶辫触锛侊紒锛�", false);
+                        }
+                    }
+                }  catch (Exception e){
+                    log.error("浠诲姟鍙凤細"+basAgvMast.getTaskNo()+"====銆婣GV浠诲姟涓嬪彂澶辫触"+e.getMessage());
+                }
+            }
+        }catch (Exception e){
+            log.error("AGV浠诲姟涓嬪彂澶辫触"+e.getMessage());
+        }
+    }
+
+    /*
+     * agv浠诲姟涓嬪彂:杈撻�佺嚎绔欑偣==銆嬭緭閫佺嚎绔欑偣
+     * */
+    public synchronized void agvTaskAssignment3() {
+        try{
+            List<BasAgvMast> basAgvMastList = basAgvMastService.selectList(new EntityWrapper<BasAgvMast>().eq("status", 0));
+            for (BasAgvMast basAgvMast : basAgvMastList) {
+                if (basAgvMast.getStatus()!=0 && basAgvMast.getIoType()!=3){//3==銆嬭緭閫佺嚎绔欑偣==銆嬭緭閫佺嚎绔欑偣
+                    continue;
+                }
+                try{
+                    // 鑾峰彇绔欑偣淇℃伅
+                    SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, basAgvMast.getDevpId());
+                    StaProtocol staProtocol = devpThread.getStation().get(basAgvMast.getSourceStaNo());
+                    if (staProtocol == null || !staProtocol.isLoading()) {
+                        continue;
+                    } else {
+                        staProtocol = staProtocol.clone();
+                    }
+                    // 鑾峰彇绔欑偣淇℃伅
+                    StaProtocol staProtocolEnd = devpThread.getStation().get(basAgvMast.getStaNo());
+                    if (staProtocolEnd == null || !staProtocolEnd.isAutoing()) {
+                        continue;
+                    } else {
+                        staProtocolEnd = staProtocolEnd.clone();
+                    }
+
+                    if (!Cools.isEmpty(staProtocol.getWorkNo()) && staProtocol.getWorkNo().equals(basAgvMast.getTaskNo())){
+
+                        AgvTaskAssignmentParam agvTaskAssignmentParam = new AgvTaskAssignmentParam();
+
+                        //浠诲姟涓嬪彂
+                        ReturnT<String> result = new PostMesDataUtils().postMesData("AGV浠诲姟涓嬪彂", AgvConstant.AGV_URL, AgvConstant.AGV_ADAPTOR, agvTaskAssignmentParam);
+                        if (result.getCode()==200){
+                            basAgvMast.setStatus(1);
+                            basAgvMastService.updateById(basAgvMast);
+                        } else {
+                            agvTaskAssignmentCallApiLogSave(basAgvMast, "AGV浠诲姟涓嬪彂澶辫触", "浠诲姟鍙凤細"+basAgvMast.getTaskNo()+"浠诲姟淇℃伅涓嬪彂澶辫触锛侊紒锛�", false);
+                        }
+                    }
+                }  catch (Exception e){
+                    log.error("浠诲姟鍙凤細"+basAgvMast.getTaskNo()+"====銆婣GV浠诲姟涓嬪彂澶辫触"+e.getMessage());
+                }
+            }
+        }catch (Exception e){
+            log.error("AGV浠诲姟涓嬪彂澶辫触"+e.getMessage());
+        }
+    }
+
+    public void agvTaskAssignmentCallApiLogSave(BasAgvMast basAgvMast ,String tableName, String response, Boolean bool) {
+        ApiLog apiLog = apiLogService.selectOne(new EntityWrapper<ApiLog>()
+                .eq("namespace", "Agv浠诲姟涓嬪彂")
+                .eq("request", "浠诲姟鍙�:" + basAgvMast.getTaskNo())
+                .eq("response", response)
+                .eq("url", tableName)
+                .eq("result", 0)
+                .orderBy("create_time", false)
+        );
+
+        if (!Cools.isEmpty(apiLog)){
+            long parseLong = Long.parseLong(apiLog.getTimestamp());
+            if (new Date().getTime()-parseLong<5*1000*60){
+                return;
+            }
+        }
+        apiLogService.save("Agv浠诲姟涓嬪彂", tableName, "null", "127.0.0.1",
+                "浠诲姟鍙�:" + basAgvMast.getTaskNo() ,
+                response, bool);
+    }
+
 }

--
Gitblit v1.9.1