From 6fcad8a10aab91b9a0825b0465b7e21d37df2332 Mon Sep 17 00:00:00 2001
From: 1 <1>
Date: 星期三, 22 十月 2025 11:53:13 +0800
Subject: [PATCH] #

---
 src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java |  385 ++++++++++++++++++++++++++++++++++++++----------------
 1 files changed, 268 insertions(+), 117 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 47e4f08..1a0084f 100644
--- a/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java
+++ b/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java
@@ -747,6 +747,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, wrkMast107.getCrnNo());
+                        CrnProtocol crnProtocol = crnThread.getCrnProtocol();
+                        if (crnProtocol.statusType == CrnStatusType.FETCHING || crnProtocol.statusType == CrnStatusType.PUTTING) {
+                            // 绉诲姩涓�
+                            continue;
+                        }
+                        //  鍒ゆ柇鍫嗗灈鏈虹姸鎬佺瓑寰呯‘璁�
+                        if (crnProtocol.modeType == CrnModeType.AUTO && crnProtocol.getTaskNo().equals(wrkMast107.getWrkNo().shortValue())
+                                && 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, wrkMast107.getCrnNo());
+                        CrnProtocol crnProtocol = crnThread.getCrnProtocol();
+                        if (crnProtocol.statusType == CrnStatusType.FETCHING || crnProtocol.statusType == CrnStatusType.PUTTING) {
+                            // 绉诲姩涓�
+                            continue;
+                        }
+                        //  鍒ゆ柇鍫嗗灈鏈虹姸鎬佺瓑寰呯‘璁�
+                        if (crnProtocol.modeType == CrnModeType.AUTO && crnProtocol.getTaskNo().equals(wrkMast107.getWrkNo().shortValue())
+                                && 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) {
@@ -828,14 +923,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 {
@@ -1040,61 +1138,62 @@
             } else {
                 staProtocol = staProtocol.clone();
             }
-//            if (slave.getId() == 3) {
-//                SiemensDevpThread devpThread1 = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, crnStn.getDevpPlcId());
-//                StaProtocol staProtocol2 = devpThread1.getStation().get(4001);
-//                if (staProtocol2 == null) {
-//                    News.infoNoLog("" + mark + " - 2" + " - 3" + " - 鍫嗗灈鏈哄嚭搴撶珯淇℃伅(staProtocol!=null缁х画鎵ц,鍚﹀垯寰幆缁堟)锛歴taProtocol=" + staProtocol2);
-//                    break;
-//                } 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 (!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) 5);     // 婧愬簱浣嶆帓
-//                    crnCommand.setSourcePosY((short) 1);     // 婧愬簱浣嶅垪
-//                    crnCommand.setSourcePosZ((short) 4);     // 婧愬簱浣嶅眰
-//                    crnCommand.setDestinationPosX((short) 6);     // 鐩爣搴撲綅鎺�
-//                    crnCommand.setDestinationPosY((short) 1);     // 鐩爣搴撲綅鍒�
-//                    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));
-//                    } 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());
-//                        }
-//                        break;
-//                    }
-//                }
-//            }
+            WrkMast wrkMast9996 = wrkMastMapper.selectByWrkNo9996(9996);
+
+            if (slave.getId() == 3 && wrkMast9996 != null) {
+                SiemensDevpThread devpThread1 = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, crnStn.getDevpPlcId());
+                StaProtocol staProtocol2 = devpThread1.getStation().get(4001);
+                if (staProtocol2 == null) {
+                    News.infoNoLog("" + mark + " - 2" + " - 3" + " - 鍫嗗灈鏈哄嚭搴撶珯淇℃伅(staProtocol!=null缁х画鎵ц,鍚﹀垯寰幆缁堟)锛歴taProtocol=" + staProtocol2);
+                    break;
+                } else {
+                    staProtocol2 = staProtocol2.clone();
+                }
+                BasDevp staDetl = basDevpService.selectById(crnStn.getStaNo());
+                if (staDetl == null) {
+                    News.error(""+mark+" - 2"+" - 5"+" - 鍑哄簱 ===>> 鍫嗗灈鏈虹珯鐐瑰湪鏁版嵁搴撲笉瀛樺湪, 绔欑偣缂栧彿={}", crnStn.getStaNo());
+                    break;
+//                    continue;
+                }
+                if( staProtocol2.isAutoing() && staProtocol2.isLoading() && staDetl.getCanining() != null && staDetl.getCanining().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);     // 婧愬簱浣嶅眰
+                    crnCommand.setDestinationPosX((short) 9);     // 鐩爣搴撲綅鎺�
+                    crnCommand.setDestinationPosY((short) 52);     // 鐩爣搴撲綅鍒�
+                    crnCommand.setDestinationPosZ((short) 2);     // 鐩爣搴撲綅灞�
+//                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(3L);
+                        wrkMast9996.setCrnStrTime(now);
+                        wrkMast9996.setModiTime(now);
+                        if (wrkMastMapper.updateById(wrkMast9996) == 0) {
+                            News.error("" + mark + " - 2" + " - 14" + " - 淇敼宸ヤ綔妗g姸鎬� 11.鐢熸垚鍑哄簱ID => 12.鍚婅溅鍑哄簱涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast9996.getWrkNo());
+                        }
+                        break;
+                    }
+                }
+            }
             // 鏌ヨ绔欑偣璇︾粏淇℃伅
             BasDevp staDetl = basDevpService.selectById(crnStn.getStaNo());
             if (staDetl == null) {
@@ -1239,61 +1338,108 @@
             // 鑾峰彇宸ヤ綔鐘舵�佷负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());
-//                StaProtocol staProtocol2 = devpThread1.getStation().get(1015);
-//                if (staProtocol2 == null) {
-//                    News.infoNoLog("" + mark + " - 2" + " - 3" + " - 鍫嗗灈鏈哄嚭搴撶珯淇℃伅(staProtocol!=null缁х画鎵ц,鍚﹀垯寰幆缁堟)锛歴taProtocol=" + staProtocol2);
-//                    break;
-//                } else {
-//                    staProtocol2 = staProtocol2.clone();
-//                }
-//                WrkMast wrkMast9999 = wrkMastMapper.selectByWrkNo(9997);
-//                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 (!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) 5);     // 婧愬簱浣嶆帓
-//                    crnCommand.setSourcePosY((short) 1);     // 婧愬簱浣嶅垪
-//                    crnCommand.setSourcePosZ((short) 1);     // 婧愬簱浣嶅眰
-//                    crnCommand.setDestinationPosX((short) 6);     // 鐩爣搴撲綅鎺�
-//                    crnCommand.setDestinationPosY((short) 1);     // 鐩爣搴撲綅鍒�
-//                    crnCommand.setDestinationPosZ((short) 4);     // 鐩爣搴撲綅灞�
-////                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));
-//                    } 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());
-//                        }
-//                        break;
-//                    }
-//                }
-//            }
+            WrkMast wrkMast9997 = wrkMastMapper.selectByWrkNo9997(9997);
+
+            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);
+                    break;
+                } else {
+                    staProtocol2 = staProtocol2.clone();
+                }
+                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(staProtocol2.isLoading() && staProtocol2.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) 9997); // 宸ヤ綔鍙�
+//                    crnCommand.setAckFinish((short) 0);  // 浠诲姟瀹屾垚纭浣�
+                    crnCommand.setTaskMode(CrnTaskModeType.LOC_MOVE); // 浠诲姟妯″紡:  搴撲綅绉昏浆
+                    crnCommand.setSourcePosX((short) 9);     // 婧愬簱浣嶆帓
+                    crnCommand.setSourcePosY((short) 52);     // 婧愬簱浣嶅垪
+                    crnCommand.setSourcePosZ((short) 1);     // 婧愬簱浣嶅眰
+                    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(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;
+                    }
+                }
+            }
             for (WrkMast wrkMast : wrkMasts) {
                 if (wrkMast == null) {
                     continue;
@@ -3325,7 +3471,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()){
@@ -3580,6 +3726,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鍙栬揣绔欑偣
@@ -3588,7 +3737,6 @@
                 basRgv.setPakRgv("0");
                 basRgvService.updateById(basRgv);
 
-//                rgvThread.setPakRgv(false);
                 continue;
             }
             wrkMastSta.setWorkSta(wrkMastSta1 !=null ? 2 : 1);//鑻�1鍙峰伐浣嶆湁浠诲姟缁�2鍙峰伐浣�
@@ -3599,8 +3747,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 ){

--
Gitblit v1.9.1