From 3677c6501ed94234f406d6444bab46e90824dac8 Mon Sep 17 00:00:00 2001
From: lsh <lsh@163.com>
Date: 星期一, 24 二月 2025 09:58:16 +0800
Subject: [PATCH] *

---
 src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java |  729 ++++++++++++++++++++++++++++++++++++++++++++-----------
 1 files changed, 577 insertions(+), 152 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 db7b609..954ea02 100644
--- a/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java
+++ b/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java
@@ -3,9 +3,9 @@
 import com.alibaba.fastjson.JSON;
 import com.alibaba.fastjson.JSONObject;
 import com.baomidou.mybatisplus.mapper.EntityWrapper;
-import com.baomidou.mybatisplus.mapper.Wrapper;
 import com.core.common.Cools;
 import com.core.common.DateUtils;
+import com.core.common.SpringUtils;
 import com.core.exception.CoolException;
 import com.zy.asrs.entity.*;
 import com.zy.asrs.mapper.*;
@@ -21,7 +21,6 @@
 import com.zy.common.utils.CollectionUtils;
 import com.zy.common.utils.HttpHandler;
 import com.zy.common.utils.RedisUtil;
-import com.zy.common.utils.RgvUtils;
 import com.zy.core.CrnThread;
 import com.zy.core.DevpThread;
 import com.zy.core.cache.MessageQueue;
@@ -74,8 +73,6 @@
     @Autowired
     private LocMastService locMastService;
     @Autowired
-    private StaDescService staDescService;
-    @Autowired
     private BasCrnpService basCrnpService;
     @Autowired
     private BasRgvService basRgvService;
@@ -94,8 +91,6 @@
     @Autowired
     private BasRgvPathService basRgvPathService;
     @Autowired
-    private RedisUtil redisUtil;
-    @Autowired
     private WrkMastStaMapper wrkMastStaMapper;
     @Autowired
     private BasRgvMapMapper basRgvMapMapper;
@@ -104,6 +99,9 @@
 
     @Value("${wms.url}")
     private String wmsUrl;
+
+    @Value("${wms.rgvOpen}")
+    private boolean rgvOpen;
 
     /**
      * 缁勬墭
@@ -138,6 +136,47 @@
                     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(5, errMsg));
+                    }
+                    continue;
                 }
 
                 // 鍏ュ嚭搴撴ā寮忓垽鏂�
@@ -386,9 +425,10 @@
 //                // 鍏ュ嚭搴撴ā寮忓垽鏂�
 //                if (devpThread.ioMode != IoModeType.PAKIN_MODE) { continue; }
 
-                if (staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.isInEnable() && staProtocol.isPakMk()) {
+                if (staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.isInEnable() && staProtocol.isPakMk() && staProtocol.getWorkNo()!=0) {
 //                    WrkMast wrkMast = wrkMastMapper.selectPickStep(barcode);
-                    WrkMast wrkMast = wrkMastMapper.selectPakInStep5(staProtocol.getSiteId(),"7");
+//                    WrkMast wrkMast = wrkMastMapper.selectPakInStep5(staProtocol.getSiteId(),"7");
+                    WrkMast wrkMast = wrkMastMapper.selectPakInStep3(staProtocol.getWorkNo());
                     if (wrkMast == null) {
                         // 鏃犳嫞鏂欐暟鎹�
                         continue;
@@ -441,7 +481,7 @@
                                     staProtocol.setStaNo(dto.getStaNo());
                                     devpThread.setPakMk(staProtocol.getSiteId(), false);
 //                                    ledThread.errorReset();
-                                    boolean result = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
+                                    boolean result = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(5, staProtocol));
                                     if (!result) {
                                         log.error("鍙戝竷鍛戒护鑷宠緭閫佺嚎闃熷垪澶辫触锛侊紒锛� [plc缂栧彿锛歿}]", devp.getId());
                                     }
@@ -1250,7 +1290,7 @@
                 continue;
             }
             if (staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.getWorkNo() > 0 && staProtocol.isInEnable()
-                    && staDetl.getCanining() != null && staDetl.getCanining().equals("Y")) {
+                    && staDetl.getCanining() != null && staDetl.getCanining().equals("Y") && staDetl.getWrkNo().equals(wrkMast.getWrkNo())) {
                 flag = true;
             }
             if (!flag) {
@@ -1511,7 +1551,7 @@
             }
             //閫�搴撴ā寮忚烦杩�118銆�119鍑哄簱浠诲姟
             if (wrkMast.getStaNo()==118 || wrkMast.getStaNo()==119){
-                RgvOneSign rgvOneSign = rgvOneSignMapper.selectOneSign();
+                RgvOneSign rgvOneSign = rgvOneSignMapper.selectOneSign("oneSign");
                 if (Cools.isEmpty(rgvOneSign) || rgvOneSign.getRgvOneSign()==1){
                     continue;
                 }
@@ -2241,7 +2281,7 @@
      */
     public synchronized void storeEmptyPlt3() {
         try{
-            RgvOneSign rgvOneSign = rgvOneSignMapper.selectOneSign();
+            RgvOneSign rgvOneSign = rgvOneSignMapper.selectOneSign("oneSign");
             if (Cools.isEmpty(rgvOneSign) || rgvOneSign.getRgvOneSign()==1){
                 return;
             }
@@ -2263,7 +2303,8 @@
                         && rgvProtocol.getStatusType1() == RgvStatusType.IDLE
                         && rgvProtocol.getStatusType2() == RgvStatusType.IDLE
                         && rgvProtocol.getTaskNo1()==0 && rgvProtocol.getTaskNo2()==0
-                        &&  (rgvProtocol.getLoaded2()==2  || rgvProtocol.getLoaded2()==3 ) ////0 鏃犵墿锛�1 涓�灞傛棤鐗╀簩灞傛湁鐗�  锛�2涓�灞傛湁鐗╀簩灞傛棤鐗� 锛堝彧鑳芥弧鏀撅級锛�3  1銆�2灞傞兘鏈夌墿  4锛氾紙锛夊彧鍏佽鎷嗙洏
+//                        &&  (rgvProtocol.getLoaded2()==2  || rgvProtocol.getLoaded2()==3 ) ////0 鏃犵墿锛�1 涓�灞傛棤鐗╀簩灞傛湁鐗�  锛�2涓�灞傛湁鐗╀簩灞傛棤鐗� 锛堝彧鑳芥弧鏀撅級锛�3  1銆�2灞傞兘鏈夌墿  4锛氾紙锛夊彧鍏佽鎷嗙洏
+                        &&  rgvProtocol.getLoaded2()==3 ////0 鏃犵墿锛�1 涓�灞傛棤鐗╀簩灞傛湁鐗�  锛�2涓�灞傛湁鐗╀簩灞傛棤鐗� 锛堝彧鑳芥弧鏀撅級锛�3  1銆�2灞傞兘鏈夌墿  4锛氾紙锛夊彧鍏佽鎷嗙洏
                 ) {
                     try {
                         WrkMast wrkMast1 = wrkMastMapper.selectPakOutStep3(122);
@@ -2276,6 +2317,7 @@
                         param.setIoType(10);
                         param.setSourceStaNo(122);
                         param.setLocType1((short)1);
+                        param.setRgvNo(rgvProtocol.getRgvNo());
                         String response = new HttpHandler.Builder()
                                 .setUri(wmsUrl)
                                 .setPath("/rpc/pakin/empty/loc/v1")
@@ -2321,7 +2363,8 @@
             DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, led.getDevpPlcId());
             // 鍛戒护闆嗗悎
             List<LedCommand> commands = new ArrayList<>();
-            // 宸ヤ綔妗i泦鍚�
+            String orderNo = null;
+                    // 宸ヤ綔妗i泦鍚�
             List<WrkMast> wrkMasts = new ArrayList<>();
             for (Integer staNo : led.getStaArr()) {
                 // 鑾峰彇鍙夎溅绔欑偣
@@ -2381,7 +2424,13 @@
 //                ledCommand.setSourceStaNo(wrkMast.getSourceStaNo());
                 if (wrkMast.getIoType() != 110 && wrkMast.getIoType() != 10) {
                     List<WrkDetl> wrkDetls = wrkDetlService.findByWorkNo(wrkMast.getWrkNo());
-                    wrkDetls.forEach(wrkDetl -> ledCommand.getMatDtos().add(new MatDto(wrkDetl)));
+                    if (Cools.isEmpty(wrkDetls)){
+                        continue;
+                    }
+                    Integer count1 = wrkDetlService.count1();
+                    Integer count2 = wrkDetlService.count2(wrkDetls.get(0).getOrderNo());
+                    Integer count3 = wrkDetlService.count3();
+                    wrkDetls.forEach(wrkDetl -> ledCommand.getMatDtos().add(new MatDto(wrkDetl,count1,count2,count3)));
                 }
                 commands.add(ledCommand);
             }
@@ -2601,69 +2650,70 @@
 
             if (null == loc) {
                 log.error("鍙屾繁搴撲綅 --- 娴呭簱浣嶉樆濉炲紓甯革紒 寰呯Щ杞祬搴撲綅锛�" + shallowLoc.getLocNo());
-                throw new CoolException("鍙屾繁搴撲綅 --- 娴呭簱浣嶉樆濉炲紓甯革紒 寰呯Щ杞祬搴撲綅锛�" + shallowLoc.getLocNo());
-            }
-
-            // 鑾峰彇宸ヤ綔鍙�
-            int workNo = commonService.getWorkNo(0);
-            // 淇濆瓨宸ヤ綔妗�
-            WrkMast wrkMast = new WrkMast();
-            wrkMast.setWrkNo(workNo);
-            wrkMast.setIoTime(new Date());
-            wrkMast.setWrkSts(11L); // 宸ヤ綔鐘舵�侊細11.鐢熸垚鍑哄簱ID
-            wrkMast.setIoType(11); // 鍏ュ嚭搴撶姸鎬侊細 11.搴撴牸绉昏浇
-            wrkMast.setIoPri(13D);
-            wrkMast.setCrnNo(crn.getId());
-            wrkMast.setSourceLocNo(shallowLoc.getLocNo()); // 婧愬簱浣�
-            wrkMast.setLocNo(loc.getLocNo()); // 鐩爣搴撲綅
-            wrkMast.setFullPlt(shallowLoc.getFullPlt()); // 婊℃澘
-            wrkMast.setPicking("N"); // 鎷f枡
-            wrkMast.setExitMk("N"); // 閫�鍑�
-            wrkMast.setEmptyMk(shallowLoc.getLocSts().equals("D") ? "Y" : "N"); // 绌烘澘
-            wrkMast.setBarcode(shallowLoc.getBarcode()); // 鎵樼洏鐮�
-            wrkMast.setLinkMis("N");
-            wrkMast.setAppeTime(new Date());
-            wrkMast.setModiTime(new Date());
-            int res = wrkMastMapper.insert(wrkMast);
-            if (res == 0) {
-                throw new CoolException("淇濆瓨宸ヤ綔妗eけ璐�");
-            }
-            // 宸ヤ綔妗f槑缁嗕繚瀛�
-            if (shallowLoc.getLocSts().equals("F")) {
-                List<LocDetl> locDetls = locDetlService.selectList(new EntityWrapper<LocDetl>().eq("loc_no", shallowLoc.getLocNo()));
-                for (LocDetl locDetl : locDetls) {
-                    WrkDetl wrkDetl = new WrkDetl();
-                    wrkDetl.setWrkNo(workNo);
-                    wrkDetl.setIoTime(new Date());
-                    wrkDetl.setAnfme(locDetl.getAnfme());
-                    VersionUtils.setWrkDetl(wrkDetl, locDetl); // 鐗堟湰鎺у埗
-                    wrkDetl.setAppeTime(new Date());
-                    wrkDetl.setModiTime(new Date());
-                    if (!wrkDetlService.insert(wrkDetl)) {
-                        throw new CoolException("淇濆瓨宸ヤ綔妗f槑缁嗗け璐�");
+//                throw new CoolException("鍙屾繁搴撲綅 --- 娴呭簱浣嶉樆濉炲紓甯革紒 寰呯Щ杞祬搴撲綅锛�" + shallowLoc.getLocNo());
+            } else {
+                // 鑾峰彇宸ヤ綔鍙�
+                int workNo = commonService.getWorkNo(0);
+                // 淇濆瓨宸ヤ綔妗�
+                WrkMast wrkMast = new WrkMast();
+                wrkMast.setWrkNo(workNo);
+                wrkMast.setIoTime(new Date());
+                wrkMast.setWrkSts(11L); // 宸ヤ綔鐘舵�侊細11.鐢熸垚鍑哄簱ID
+                wrkMast.setIoType(11); // 鍏ュ嚭搴撶姸鎬侊細 11.搴撴牸绉昏浇
+                wrkMast.setIoPri(13D);
+                wrkMast.setCrnNo(crn.getId());
+                wrkMast.setSourceLocNo(shallowLoc.getLocNo()); // 婧愬簱浣�
+                wrkMast.setLocNo(loc.getLocNo()); // 鐩爣搴撲綅
+                wrkMast.setFullPlt(shallowLoc.getFullPlt()); // 婊℃澘
+                wrkMast.setPicking("N"); // 鎷f枡
+                wrkMast.setExitMk("N"); // 閫�鍑�
+                wrkMast.setEmptyMk(shallowLoc.getLocSts().equals("D") ? "Y" : "N"); // 绌烘澘
+                wrkMast.setBarcode(shallowLoc.getBarcode()); // 鎵樼洏鐮�
+                wrkMast.setLinkMis("N");
+                wrkMast.setAppeTime(new Date());
+                wrkMast.setModiTime(new Date());
+                int res = wrkMastMapper.insert(wrkMast);
+                if (res == 0) {
+                    throw new CoolException("淇濆瓨宸ヤ綔妗eけ璐�");
+                }
+                // 宸ヤ綔妗f槑缁嗕繚瀛�
+                if (shallowLoc.getLocSts().equals("F")) {
+                    List<LocDetl> locDetls = locDetlService.selectList(new EntityWrapper<LocDetl>().eq("loc_no", shallowLoc.getLocNo()));
+                    for (LocDetl locDetl : locDetls) {
+                        WrkDetl wrkDetl = new WrkDetl();
+                        wrkDetl.setWrkNo(workNo);
+                        wrkDetl.setIoTime(new Date());
+                        wrkDetl.setAnfme(locDetl.getAnfme());
+                        VersionUtils.setWrkDetl(wrkDetl, locDetl); // 鐗堟湰鎺у埗
+                        wrkDetl.setAppeTime(new Date());
+                        wrkDetl.setModiTime(new Date());
+                        if (!wrkDetlService.insert(wrkDetl)) {
+                            throw new CoolException("淇濆瓨宸ヤ綔妗f槑缁嗗け璐�");
+                        }
                     }
                 }
-            }
-            // 淇敼婧愬簱浣嶇姸鎬�
-            if (shallowLoc.getLocSts().equals("D") || shallowLoc.getLocSts().equals("F")) {
-                shallowLoc.setLocSts("R"); // R.鍑哄簱棰勭害
-                shallowLoc.setModiTime(new Date());
-                if (!locMastService.updateById(shallowLoc)) {
-                    throw new CoolException("鏇存柊婧愬簱浣嶇姸鎬佸け璐�");
+                // 淇敼婧愬簱浣嶇姸鎬�
+                if (shallowLoc.getLocSts().equals("D") || shallowLoc.getLocSts().equals("F")) {
+                    shallowLoc.setLocSts("R"); // R.鍑哄簱棰勭害
+                    shallowLoc.setModiTime(new Date());
+                    if (!locMastService.updateById(shallowLoc)) {
+                        throw new CoolException("鏇存柊婧愬簱浣嶇姸鎬佸け璐�");
+                    }
+                } else {
+                    throw new CoolException("婧愬簱浣嶅嚭搴撳け璐�");
                 }
-            } else {
-                throw new CoolException("婧愬簱浣嶅嚭搴撳け璐�");
-            }
-            // 淇敼鐩爣搴撲綅鐘舵��
-            if (loc.getLocSts().equals("O")) {
-                loc.setLocSts("S"); // S.鍏ュ簱棰勭害
-                loc.setModiTime(new Date());
-                if (!locMastService.updateById(loc)) {
-                    throw new CoolException("鏇存柊鐩爣搴撲綅鐘舵�佸け璐�");
+                // 淇敼鐩爣搴撲綅鐘舵��
+                if (loc.getLocSts().equals("O")) {
+                    loc.setLocSts("S"); // S.鍏ュ簱棰勭害
+                    loc.setModiTime(new Date());
+                    if (!locMastService.updateById(loc)) {
+                        throw new CoolException("鏇存柊鐩爣搴撲綅鐘舵�佸け璐�");
+                    }
+                } else {
+                    throw new CoolException("绉昏浆澶辫触");
                 }
-            } else {
-                throw new CoolException("绉昏浆澶辫触");
             }
+
         } catch (Exception e) {
             log.error("鍙屾繁搴撲綅闃诲锛屽娴呭簱浣嶈繘琛岀Щ杞け璐�", e);
             e.printStackTrace();
@@ -3241,8 +3291,20 @@
                     staProtocol = staProtocol.clone();
                 }
 
+                StaProtocol staProtocol147 = devpThread.getStation().get(147);
+                if (staProtocol147 == null) {
+                    continue;
+                } else {
+                    staProtocol147 = staProtocol147.clone();
+                }
+
                 if (!staProtocol.isLoading()){
                     log.info("{}绔欑偣鏃犵墿锛屽紓甯革紒",staNo);
+                    continue;
+                }
+
+                if (staProtocol147.isLoading()){
+                    log.info("{}绔欑偣鏈夌墿锛�",staProtocol147.getSiteId());
                     continue;
                 }
                 // 鍒ゆ柇鏄惁婊¤冻鍏ュ簱鏉′欢
@@ -3250,6 +3312,9 @@
                         && staProtocol.isLoading()
                         && !staProtocol.isEmptyMk()
                 ) {
+
+                    boolean result3 = MessageQueue.offer(SlaveType.Devp, 1, new Task(3, staProtocol147));
+
                     staProtocol.setWorkNo(wrkMast.getWrkNo());
                     staProtocol.setStaNo(wrkMast.getStaNo());
                     devpThread.setPakMk(staProtocol.getSiteId(), false);
@@ -3257,8 +3322,12 @@
                     if (!result) {
                         throw new CoolException("鏇存柊plc绔欑偣淇℃伅澶辫触==>椹卞姩鐮佸灈浣嶆墭鐩樺墠杩涘け璐ワ紒");
                     }
+
                     wrkMast.setSheetNo("5");
                     wrkMastMapper.updateById(wrkMast);
+
+                    boolean result4 = MessageQueue.offer(SlaveType.Devp, 1, new Task(4, staProtocol147));
+
                 }
             }
         }catch (Exception e){
@@ -3281,6 +3350,14 @@
                     continue;
                 }
                 if (basDevp135.getReportSign()!=0){
+                    continue;
+                }
+                BasDevp basDevp121 = basDevpService.selectById(121);
+                if (basDevp121.getReportSign()!=0){
+                    continue;
+                }
+                BasDevp basDevp120 = basDevpService.selectById(120);
+                if (basDevp120.getReportSign()!=0){
                     continue;
                 }
                 WrkMast wrkMast131 = wrkMastMapper.selectWrkMastUnstackingOne202Two(131);
@@ -3307,6 +3384,26 @@
                 }
 
                 if (!staProtocol.isLoading()){
+                    continue;
+                }
+                StaProtocol staProtocol120 = devpThread.getStation().get(120);
+                if (staProtocol120 == null) {
+                    continue;
+                } else {
+                    staProtocol120 = staProtocol120.clone();
+                }
+
+                if (staProtocol120.isLoading()){
+                    continue;
+                }
+                StaProtocol staProtocol121 = devpThread.getStation().get(121);
+                if (staProtocol121 == null) {
+                    continue;
+                } else {
+                    staProtocol121 = staProtocol121.clone();
+                }
+
+                if (staProtocol121.isLoading()){
                     continue;
                 }
 //                if (!staProtocol.getWorkNo().equals(wrkMast131.getWrkNo())){
@@ -3388,10 +3485,15 @@
                             continue;
                         }
                         WrkMast wrkMast = wrkMastMapper.selectPakInStep3(wrkMastSta.getWrkNo().intValue());
-                        if (!Cools.isEmpty(wrkMast)){
+                        if (!Cools.isEmpty(wrkMast) && wrkMastSta.getWrkType()!=5){
                             Thread.sleep(200);
-                            DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, 1);
+                            SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, 1);
                             StaProtocol staProtocol = devpThread.getStation().get(wrkMastSta.getStaEnd());
+                            if (staProtocol == null) {
+                                continue;
+                            } else {
+                                staProtocol = staProtocol.clone();
+                            }
                             if (!staProtocol.isAutoing() || !staProtocol.isLoading()){
                                 continue;
                             }
@@ -3446,7 +3548,7 @@
                             continue;
                         }
                         WrkMast wrkMast = wrkMastMapper.selectPakInStep3(wrkMastSta.getWrkNo().intValue());
-                        if (!Cools.isEmpty(wrkMast)){
+                        if (!Cools.isEmpty(wrkMast)  && wrkMastSta.getWrkType()!=5){
                             Thread.sleep(200);
                             DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, 1);
                             StaProtocol staProtocol = devpThread.getStation().get(wrkMastSta.getStaEnd());
@@ -3527,20 +3629,20 @@
                     switch (sign){
                         //鎵ц灏忚溅璐х墿鎼繍浠诲姟
                         case 1:
-                            signWork = rgvRunWrkMastFullSta();
+                            signWork = rgvRunWrkMastFullSta(rgvSlave);
                             break;
                         //鎵ц灏忚溅绌烘澘鎼繍浠诲姟
                         case 2://鏀�//鎷嗙洏
-                            signWork = rgvRunWrkMastEmptyStaPut();
+                            signWork = rgvRunWrkMastEmptyStaPut(rgvSlave);
                             break;
                         case 3://婊℃斁
-                            signWork = rgvRunWrkMastEmptyStaPutFull();
+                            signWork = rgvRunWrkMastEmptyStaPutFull(rgvSlave);
                             break;
                         case 4://鍙栧彔鐩�
-                            signWork = rgvRunWrkMastEmptyStaTake();
+                            signWork = rgvRunWrkMastEmptyStaTake(rgvSlave);
                             break;
                         case 5:////婊″彇
-                            signWork = rgvRunWrkMastEmptyStaTakeFull();
+                            signWork = rgvRunWrkMastEmptyStaTakeFull(rgvSlave);
                             break;
                         case 6:////鎻愬崌
 //                            signWork = qwe();
@@ -3548,40 +3650,42 @@
                         default:
                             break;
                     }
-                }
-                for (int signCount = 1;!signWork && signCount<7;signCount++){
-                    switch (signCount){
-                        case 1://鎵ц灏忚溅璐х墿鎼繍浠诲姟
-                            signWork = rgvRunWrkMastFullSta();
-                            break;
-                        case 2://鏀�//鎷嗙洏
-                            signWork = rgvRunWrkMastEmptyStaPut();
-                            break;
-                        case 3://婊℃斁
-                            signWork = rgvRunWrkMastEmptyStaPutFull();
-                            break;
-                        case 4://鍙栧彔鐩�
-                            signWork = rgvRunWrkMastEmptyStaTake();
-                            break;
-                        case 5:////婊″彇
-                            signWork = rgvRunWrkMastEmptyStaTakeFull();
-                            break;
-                        case 6:////鎻愬崌
+                    for (int signCount = 1;!signWork && signCount<7;signCount++){
+                        switch (signCount){
+                            case 1://鎵ц灏忚溅璐х墿鎼繍浠诲姟
+                                signWork = rgvRunWrkMastFullSta(rgvSlave);
+                                break;
+                            case 2://鏀�//鎷嗙洏
+                                signWork = rgvRunWrkMastEmptyStaPut(rgvSlave);
+                                break;
+                            case 3://婊℃斁
+                                signWork = rgvRunWrkMastEmptyStaPutFull(rgvSlave);
+                                break;
+                            case 4://鍙栧彔鐩�
+                                signWork = rgvRunWrkMastEmptyStaTake(rgvSlave);
+                                break;
+                            case 5:////婊″彇
+                                signWork = rgvRunWrkMastEmptyStaTakeFull(rgvSlave);
+                                break;
+                            case 6:////鎻愬崌
 //                            signWork = rgvRunWrkMastEmptyStaPut();
-                            break;
-                        default:
-                            break;
+                                break;
+                            default:
+                                break;
+                        }
                     }
+                }else {
+                    continue;
                 }
                 if (!rgvIoExecuteSign){
                     rgvIoExecuteSign = signWork;
                 }
             }
-            if (!rgvIoExecuteSign){
-                if (sign>6){
-                    rgvRunWrkMastEmptyStaAvoidance();//閬胯
-                }
-            }
+//            if (!rgvIoExecuteSign){
+//                if (sign>6){
+//
+//                }
+//            }
         }catch (Exception e){
             log.error("RGV灏忚溅浠诲姟涓嬪彂鎶ラ敊"+e);
         }
@@ -3590,18 +3694,18 @@
     /**
      * 鎵ц灏忚溅鎼繍浠诲姟
      */
-    public synchronized boolean rgvRunWrkMastFullSta() {
+    public synchronized boolean rgvRunWrkMastFullSta(RgvSlave rgvSlave) {
         try{
-            for (RgvSlave rgvSlave:slaveProperties.getRgv()) {
+//            for (RgvSlave rgvSlave:slaveProperties.getRgv()) {
                 RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgvSlave.getId());
                 RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
                 if (rgvProtocol == null) {
-                    continue;
+                    return false;
                 }
                 BasRgv basRgv = basRgvService.selectById(rgvSlave.getId());
                 if (basRgv == null) {
                     log.error("{}鍙稲GV灏氭湭鍦ㄦ暟鎹簱杩涜缁存姢锛�", rgvSlave.getId());
-                    continue;
+                    return false;
                 }
 
                 // 鍙湁褰揜GV绌洪棽銆佽嚜鍔�,宸ヤ綅涓�鏃犵墿//rgv鍙敤
@@ -3615,7 +3719,7 @@
                     BasRgvMap basRgvMap = basRgvMapMapper.selectById(basRgv.getRgvNo());
                     if (basRgvMap == null) {
                         log.error("{}鍙稲GV灏氭湭鍦ㄦ暟鎹簱鍦板浘涓繘琛岀淮鎶わ紒", rgvProtocol.getRgvNo());
-                        continue;
+                        return false;
                     }
                     List<Integer> route = RouteUtils.getRoute(basRgvMap.getStartRoute(), basRgvMap.getEndRoute());
                     basRgvMap.setNowRoute(rgvProtocol.getRgvPosI()); //鏇存柊灏忚溅褰撳墠浣嶇疆绔欑偣鍙�
@@ -3625,9 +3729,56 @@
                             continue;
                         }
                         BasDevp basDevp = basDevpService.selectById(wrkMastSta.getStaEnd());
-                        if (!basDevp.getAutoing().equals("Y") || basDevp.getLoading().equals("Y")){
+                        if (!basDevp.getAutoing().equals("Y") || basDevp.getLoading().equals("Y") || basDevp.getWrkNo()!=0){
                             continue;
                         }
+                        if (basDevp.getDevNo()>117 && basDevp.getDevNo()<124){
+                            if (basDevp.getLoadingSuper().equals("Y")){
+                                continue;
+                            }
+                        }
+                        if (basDevp.getDevNo()>=118 && basDevp.getDevNo()<=123){
+                            if (!basDevp.getEmptyMk().equals("Y")){
+                                continue;
+                            }
+                        }
+                        Date date = new Date();
+
+                        SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, rgvSlave.getDevpPlcId());
+                        StaProtocol staProtocol = devpThread.getStation().get(basDevp.getDevNo());
+                        if (staProtocol == null) {
+                            log.info(date+"鍙栨斁浠诲姟涓嬪彂锛氭湭鏌ヨ鍒扮珯鐐逛俊鎭細"+wrkMastSta);
+                            continue;
+                        }
+                        if (!staProtocol.isAutoing() || staProtocol.isLoading() || staProtocol.getWorkNo() != 0){
+                            continue;
+                        }
+                        if (basDevp.getDevNo()>117 && basDevp.getDevNo()<124){
+                            if (staProtocol.isLoadingSuper()){
+                                continue;
+                            }
+                        }
+                        if (basDevp.getDevNo()>=118 && basDevp.getDevNo()<=123){
+                            if (!staProtocol.isEmptyMk()){
+                                continue;
+                            }
+                        }
+                        BasDevp basDevpS = basDevpService.selectById(wrkMastSta.getStaStart());
+                        if (!basDevpS.getAutoing().equals("Y") || !basDevpS.getLoading().equals("Y") || basDevpS.getWrkNo()!=wrkMastSta.getWrkNo().intValue()){
+                            continue;
+                        }
+                        StaProtocol staProtocols = devpThread.getStation().get(basDevpS.getDevNo());
+                        if (staProtocols == null) {
+                            log.info(date+"鍙栨斁浠诲姟涓嬪彂锛氭湭鏌ヨ鍒扮珯鐐逛俊鎭細"+wrkMastSta);
+                            continue;
+                        }
+                        if (!staProtocols.isAutoing() || !staProtocols.isLoading() || staProtocols.getWorkNo() != wrkMastSta.getWrkNo().intValue()){
+                            continue;
+                        }
+
+
+                        log.info(date+"鍙栨斁浠诲姟涓嬪彂锛氬皬杞﹀伐浣滄。锛�"+wrkMastSta);
+                        log.info(date+"鍙栨斁浠诲姟涓嬪彂锛氱洰鏍囩珯鐘舵�侊細"+basDevp);
                         boolean sign = rgvTakeFullAll(basRgvMap.getRgvNo(), wrkMastSta);
                         if (sign){
                             boolean signMap = rgvMapUpdate(basRgvMap, wrkMastSta.getStaStart(), wrkMastSta.getStaEnd());
@@ -3648,7 +3799,7 @@
                         break;
                     }
                 }
-            }
+//            }
         }catch (Exception e){
             log.error("3875琛屾墽琛屽皬杞︽惉杩愪换鍔′笅鍙戝け璐�");
             log.error("3875琛�"+e);
@@ -3658,18 +3809,18 @@
     /**
      * 鎵ц灏忚溅鎼繍浠诲姟//鎷嗙洏
      */
-    public synchronized boolean rgvRunWrkMastEmptyStaPut() {//鎷嗙洏
+    public synchronized boolean rgvRunWrkMastEmptyStaPut(RgvSlave rgvSlave) {//鎷嗙洏
         try{
-            for (RgvSlave rgvSlave:slaveProperties.getRgv()) {
+//            for (RgvSlave rgvSlave:slaveProperties.getRgv()) {
                 RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgvSlave.getId());
                 RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
                 if (rgvProtocol == null) {
-                    continue;
+                    return false;
                 }
                 BasRgv basRgv = basRgvService.selectById(rgvSlave.getId());
                 if (basRgv == null) {
                     log.error("{}鍙稲GV灏氭湭鍦ㄦ暟鎹簱杩涜缁存姢锛�", rgvSlave.getId());
-                    continue;
+                    return false;
                 }
 
                 // 鍙湁褰揜GV绌洪棽銆佽嚜鍔�,宸ヤ綅浜屾湁鐗�//rgv鍙敤//鎷嗙洏
@@ -3683,7 +3834,7 @@
                     BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
                     if (basRgvMap == null) {
                         log.error("{}鍙稲GV灏氭湭鍦ㄦ暟鎹簱鍦板浘涓繘琛岀淮鎶わ紒", rgvProtocol.getRgvNo());
-                        continue;
+                        return false;
                     }
                     basRgvMap.setNowRoute(rgvProtocol.getRgvPosI()); //鏇存柊灏忚溅褰撳墠浣嶇疆绔欑偣鍙�
                     List<Integer> route = RouteUtils.getRoute(basRgvMap.getStartRoute(), basRgvMap.getEndRoute());//鑾峰彇娲诲姩鑼冨洿
@@ -3695,9 +3846,43 @@
                         boolean sign = false;
                         if ( wrkMastSta.getStaEnd()!=0){//鏀�
                             BasDevp basDevp = basDevpService.selectById(wrkMastSta.getStaEnd());
-                            if (!basDevp.getAutoing().equals("Y") || basDevp.getLoading().equals("Y")){
+                            if (!basDevp.getAutoing().equals("Y") || basDevp.getLoading().equals("Y") || basDevp.getWrkNo()!=0){
                                 continue;
                             }
+                            if (basDevp.getDevNo()>117 && basDevp.getDevNo()<124){
+                                if (basDevp.getLoadingSuper().equals("Y")){
+                                    continue;
+                                }
+                            }
+                            if (basDevp.getDevNo()>=118 && basDevp.getDevNo()<=123){
+                                if (!basDevp.getEmptyMk().equals("Y")){
+                                    continue;
+                                }
+                            }
+                            Date date = new Date();
+
+                            SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, rgvSlave.getDevpPlcId());
+                            StaProtocol staProtocol = devpThread.getStation().get(basDevp.getDevNo());
+                            if (staProtocol == null) {
+                                log.info(date+"鎷嗙洏浠诲姟涓嬪彂锛氭湭鏌ヨ鍒扮珯鐐逛俊鎭細"+wrkMastSta);
+                                continue;
+                            }
+                            if (!staProtocol.isAutoing() || staProtocol.isLoading() || staProtocol.getWorkNo() != 0){
+                                continue;
+                            }
+                            if (basDevp.getDevNo()>117 && basDevp.getDevNo()<124){
+                                if (staProtocol.isLoadingSuper()){
+                                    continue;
+                                }
+                            }
+                            if (basDevp.getDevNo()>=118 && basDevp.getDevNo()<=123){
+                                if (!staProtocol.isEmptyMk()){
+                                    continue;
+                                }
+                            }
+
+                            log.info(date+"鎷嗙洏浠诲姟涓嬪彂锛氬皬杞﹀伐浣滄。锛�"+wrkMastSta);
+                            log.info(date+"鎷嗙洏浠诲姟涓嬪彂锛氱洰鏍囩珯鐘舵�侊細"+basDevp);
                             sign = rgvPutEmpty(rgvProtocol.getRgvNo(),wrkMastSta);//鎷嗙洏
                         }else {
                             continue;
@@ -3721,7 +3906,7 @@
                         break;
                     }
                 }
-            }
+//            }
         }catch (Exception e){
             log.error("3933琛屾墽琛屽皬杞︽斁绌烘澘浠诲姟涓嬪彂澶辫触");
             log.error("3933琛�"+e);
@@ -3732,18 +3917,18 @@
     /**
      * 鎵ц灏忚溅鎼繍浠诲姟
      */
-    public synchronized boolean rgvRunWrkMastEmptyStaPutFull() {//婊℃斁
+    public synchronized boolean rgvRunWrkMastEmptyStaPutFull(RgvSlave rgvSlave) {//婊℃斁
         try{
-            for (RgvSlave rgvSlave:slaveProperties.getRgv()) {
+//            for (RgvSlave rgvSlave:slaveProperties.getRgv()) {
                 RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgvSlave.getId());
                 RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
                 if (rgvProtocol == null) {
-                    continue;
+                    return false;
                 }
                 BasRgv basRgv = basRgvService.selectById(rgvSlave.getId());
                 if (basRgv == null) {
                     log.error("{}鍙稲GV灏氭湭鍦ㄦ暟鎹簱杩涜缁存姢锛�", rgvSlave.getId());
-                    continue;
+                    return false;
                 }
 
                 // 鍙湁褰揜GV绌洪棽銆佽嚜鍔�,宸ヤ綅浜屾湁鐗�//rgv鍙敤
@@ -3757,7 +3942,7 @@
                     BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
                     if (basRgvMap == null) {
                         log.error("{}鍙稲GV灏氭湭鍦ㄦ暟鎹簱鍦板浘涓繘琛岀淮鎶わ紒", rgvProtocol.getRgvNo());
-                        continue;
+                        return false;
                     }
                     basRgvMap.setNowRoute(rgvProtocol.getRgvPosI()); //鏇存柊灏忚溅褰撳墠浣嶇疆绔欑偣鍙�
                     List<Integer> route = RouteUtils.getRoute(basRgvMap.getStartRoute(), basRgvMap.getEndRoute());//鑾峰彇娲诲姩鑼冨洿
@@ -3769,9 +3954,43 @@
                         boolean sign = false;
                         if ( wrkMastSta.getStaEnd()!=0){//婊℃斁
                             BasDevp basDevp = basDevpService.selectById(wrkMastSta.getStaEnd());
-                            if (!basDevp.getAutoing().equals("Y") || basDevp.getLoading().equals("Y")){
+                            if (!basDevp.getAutoing().equals("Y") || basDevp.getLoading().equals("Y") || basDevp.getWrkNo()!=0){
                                 continue;
                             }
+                            if (basDevp.getDevNo()>117 && basDevp.getDevNo()<124){
+                                if (basDevp.getLoadingSuper().equals("Y")){
+                                    continue;
+                                }
+                            }
+                            if (basDevp.getDevNo()>=118 && basDevp.getDevNo()<=123){
+                                if (!basDevp.getEmptyMk().equals("Y")){
+                                    continue;
+                                }
+                            }
+                            Date date = new Date();
+
+                            SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, rgvSlave.getDevpPlcId());
+                            StaProtocol staProtocol = devpThread.getStation().get(basDevp.getDevNo());
+                            if (staProtocol == null) {
+                                log.info(date+"婊℃斁浠诲姟涓嬪彂锛氭湭鏌ヨ鍒扮珯鐐逛俊鎭細"+wrkMastSta);
+                                continue;
+                            }
+                            if (!staProtocol.isAutoing() || staProtocol.isLoading() || staProtocol.getWorkNo() != 0){
+                                continue;
+                            }
+                            if (basDevp.getDevNo()>117 && basDevp.getDevNo()<124){
+                                if (staProtocol.isLoadingSuper()){
+                                    continue;
+                                }
+                            }
+                            if (basDevp.getDevNo()>=118 && basDevp.getDevNo()<=123){
+                                if (!staProtocol.isEmptyMk()){
+                                    continue;
+                                }
+                            }
+
+                            log.info(date+"婊℃斁浠诲姟涓嬪彂锛氬皬杞﹀伐浣滄。锛�"+wrkMastSta);
+                            log.info(date+"婊℃斁浠诲姟涓嬪彂锛氱洰鏍囩珯鐘舵�侊細"+basDevp);
                             sign = rgvPutEmptyFull(rgvProtocol.getRgvNo(),wrkMastSta);
                         }else {
                             continue;
@@ -3795,7 +4014,7 @@
                         break;
                     }
                 }
-            }
+//            }
         }catch (Exception e){
             log.error("3933琛屾墽琛屽皬杞︽斁绌烘澘浠诲姟涓嬪彂澶辫触");
             log.error("3933琛�"+e);
@@ -3803,18 +4022,18 @@
         return false;
     }
 
-    public synchronized boolean rgvRunWrkMastEmptyStaTake() {//鍙犵洏
+    public synchronized boolean rgvRunWrkMastEmptyStaTake(RgvSlave rgvSlave) {//鍙犵洏
         try{
-            for (RgvSlave rgvSlave:slaveProperties.getRgv()) {
+//            for (RgvSlave rgvSlave:slaveProperties.getRgv()) {
                 RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgvSlave.getId());
                 RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
                 if (rgvProtocol == null) {
-                    continue;
+                    return false;
                 }
                 BasRgv basRgv = basRgvService.selectById(rgvSlave.getId());
                 if (basRgv == null) {
                     log.error("{}鍙稲GV灏氭湭鍦ㄦ暟鎹簱杩涜缁存姢锛�", rgvSlave.getId());
-                    continue;
+                    return false;
                 }
 
                 // 鍙湁褰揜GV绌洪棽銆佽嚜鍔�,宸ヤ綅浜屾棤鐗�//rgv鍙敤
@@ -3828,7 +4047,7 @@
                     BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
                     if (basRgvMap == null) {
                         log.error("{}鍙稲GV灏氭湭鍦ㄦ暟鎹簱鍦板浘涓繘琛岀淮鎶わ紒", rgvProtocol.getRgvNo());
-                        continue;
+                        return false;
                     }
                     List<Integer> route = RouteUtils.getRoute(basRgvMap.getStartRoute(), basRgvMap.getEndRoute());
                     basRgvMap.setNowRoute(rgvProtocol.getRgvPosI()); //鏇存柊灏忚溅褰撳墠浣嶇疆绔欑偣鍙�
@@ -3843,6 +4062,30 @@
                             if (!basDevp.getAutoing().equals("Y") || !basDevp.getLoading().equals("Y")){
                                 continue;
                             }
+                            if (basDevp.getDevNo()>=118 && basDevp.getDevNo()<=123){
+                                if (!basDevp.getEmptyMk().equals("Y")){
+                                    continue;
+                                }
+                            }
+                            Date date = new Date();
+
+                            SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, rgvSlave.getDevpPlcId());
+                            StaProtocol staProtocol = devpThread.getStation().get(basDevp.getDevNo());
+                            if (staProtocol == null) {
+                                log.info(date+"鍙犵洏浠诲姟涓嬪彂锛氭湭鏌ヨ鍒扮珯鐐逛俊鎭細"+wrkMastSta);
+                                continue;
+                            }
+                            if (!staProtocol.isAutoing() || !staProtocol.isLoading()){
+                                continue;
+                            }
+                            if (basDevp.getDevNo()>=118 && basDevp.getDevNo()<=123){
+                                if (!staProtocol.isEmptyMk()){
+                                    continue;
+                                }
+                            }
+
+                            log.info(date+"鍙犵洏浠诲姟涓嬪彂锛氬皬杞﹀伐浣滄。锛�"+wrkMastSta);
+                            log.info(date+"鍙犵洏浠诲姟涓嬪彂锛氱洰鏍囩珯鐘舵�侊細"+basDevp);
                             sign = rgvTakeEmpty(rgvProtocol.getRgvNo(),wrkMastSta);//鍙犵洏
                         }else {
                             continue;
@@ -3866,7 +4109,7 @@
                         break;
                     }
                 }
-            }
+//            }
         }catch (Exception e){
             log.error("3989琛屾墽琛屽皬杞﹀彇绌烘澘浠诲姟涓嬪彂澶辫触");
             log.error("3989琛�"+e);
@@ -3874,18 +4117,18 @@
         return false;
     }
 
-    public synchronized boolean rgvRunWrkMastEmptyStaTakeFull() {//婊″彇
+    public synchronized boolean rgvRunWrkMastEmptyStaTakeFull(RgvSlave rgvSlave) {//婊″彇
         try{
-            for (RgvSlave rgvSlave:slaveProperties.getRgv()) {
+//            for (RgvSlave rgvSlave:slaveProperties.getRgv()) {
                 RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgvSlave.getId());
                 RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
                 if (rgvProtocol == null) {
-                    continue;
+                    return false;
                 }
                 BasRgv basRgv = basRgvService.selectById(rgvSlave.getId());
                 if (basRgv == null) {
                     log.error("{}鍙稲GV灏氭湭鍦ㄦ暟鎹簱杩涜缁存姢锛�", rgvSlave.getId());
-                    continue;
+                    return false;
                 }
 
                 // 鍙湁褰揜GV绌洪棽銆佽嚜鍔�,宸ヤ綅浜屾棤鐗�//rgv鍙敤
@@ -3899,11 +4142,18 @@
                     BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
                     if (basRgvMap == null) {
                         log.error("{}鍙稲GV灏氭湭鍦ㄦ暟鎹簱鍦板浘涓繘琛岀淮鎶わ紒", rgvProtocol.getRgvNo());
-                        continue;
+                        return false;
                     }
                     List<Integer> route = RouteUtils.getRoute(basRgvMap.getStartRoute(), basRgvMap.getEndRoute());
                     basRgvMap.setNowRoute(rgvProtocol.getRgvPosI()); //鏇存柊灏忚溅褰撳墠浣嶇疆绔欑偣鍙�
                     List<WrkMastSta> wrkMastStaList = wrkMastStaMapper.selectNoInterfereList(route, route);
+                    WrkMast wrkMast = wrkMastMapper.selectBy122ManQu(122,110,15L);
+                    if (!Cools.isEmpty(wrkMast)){
+                        WrkMastSta wrkMastSta = wrkMastStaMapper.selectByWrkNo(wrkMast.getWrkNo().longValue());
+                        if (!Cools.isEmpty(wrkMastSta) && wrkMastSta.getType()==2 && wrkMastSta.getWrkType()==5 ){
+                            wrkMastStaList.add(wrkMastSta);
+                        }
+                    }
                     for (WrkMastSta wrkMastSta : wrkMastStaList){
                         if (wrkMastSta.getType()!=2 || wrkMastSta.getWrkType()!=5){// 2:绌烘澘  || 宸ヤ綔绫诲瀷  1:鍙栵紙鍙犵洏锛�  2锛氭媶鐩�  5锛氭弧鍙�  6锛氭弧鏀�
                             continue;
@@ -3914,6 +4164,20 @@
                             if (!basDevp.getAutoing().equals("Y") || !basDevp.getLoading().equals("Y")){
                                 continue;
                             }
+                            Date date = new Date();
+
+                            SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, rgvSlave.getDevpPlcId());
+                            StaProtocol staProtocol = devpThread.getStation().get(basDevp.getDevNo());
+                            if (staProtocol == null) {
+                                log.info(date+"婊″彇浠诲姟涓嬪彂锛氭湭鏌ヨ鍒扮珯鐐逛俊鎭細"+wrkMastSta);
+                                continue;
+                            }
+                            if (!staProtocol.isAutoing() || staProtocol.isLoading()){
+                                continue;
+                            }
+
+                            log.info(date+"婊″彇浠诲姟涓嬪彂锛氬皬杞﹀伐浣滄。锛�"+wrkMastSta);
+                            log.info(date+"婊″彇浠诲姟涓嬪彂锛氱洰鏍囩珯鐘舵�侊細"+basDevp);
                             sign = rgvTakeEmptyFull(rgvProtocol.getRgvNo(),wrkMastSta);
                         }else {
                             continue;
@@ -3937,7 +4201,7 @@
                         break;
                     }
                 }
-            }
+//            }
         }catch (Exception e){
             log.error("3989琛屾墽琛屽皬杞﹀彇绌烘澘浠诲姟涓嬪彂澶辫触");
             log.error("3989琛�"+e);
@@ -3950,10 +4214,17 @@
     * */
     public synchronized void rgvRunWrkMastEmptyStaAvoidance() {
         try{
-            Integer integer = wrkMastStaMapper.selectAllWrkStsCount(null,0);//鏌ヨ鐘舵�佷负0鐨勪换鍔�
-            if (integer==0){
+//            Integer integer = wrkMastStaMapper.selectAllWrkStsCount(null,0);//鏌ヨ鐘舵�佷负0鐨勪换鍔�
+//            if (integer==0){
+//                return;
+//            }
+            WrkMastSta wrkMastSta = wrkMastStaMapper.selectAllWrkStsCountWrkMastSta(null, 0);
+            if (Cools.isEmpty(wrkMastSta)){
                 return;
             }
+            boolean signRgv = true;
+            boolean signRgv1 = true;
+            boolean signRgv2 = true;
             for (RgvSlave rgvSlave:slaveProperties.getRgv()) {
                 RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgvSlave.getId());
                 RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
@@ -3975,19 +4246,85 @@
                         && rgvProtocol.getStatusType1() == RgvStatusType.IDLE
                         && rgvProtocol.getStatusType2() == RgvStatusType.IDLE
                 ) {
-                    BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
-                    if (rgvProtocol.getRgvPosI().equals(basRgvMap.getStartRoute())){
+                    if (rgvProtocol.getRgvNo()!=1){
+                        if (!rgvProtocol.getRgvPosI().equals(120) && !rgvProtocol.getRgvPosI().equals(110)){
+                            continue;
+                        }
+                        rgvAvoidanceXY(rgvProtocol.getRgvNo());
+//                        return;
                         continue;
                     }
-                    if (rgvProtocol.getRgvNo()==1 && (rgvProtocol.getRgvPosI().equals(101) || rgvProtocol.getRgvPosI().equals(102) )){
-                        continue;
-                    } else if (rgvProtocol.getRgvNo()==2 && (rgvProtocol.getRgvPosI().equals(116) || rgvProtocol.getRgvPosI().equals(117) ) ){
+                    if (!rgvProtocol.getRgvPosI().equals(110) && !rgvProtocol.getRgvPosI().equals(108) &&  !rgvProtocol.getRgvPosI().equals(119)){
                         continue;
                     }
+                    Integer count108Y = wrkMastStaMapper.selectAllWrkCount108Y();
+                    if (count108Y!=0){
+                        continue;
+                    }
+//                    Integer count108 = wrkMastStaMapper.selectAllWrkCount108();
+//                    if (count108!=0){
+//                        continue;
+//                    }
                     rgvAvoidanceXY(rgvProtocol.getRgvNo());
-                    rgvMapUpdate(basRgvMap,basRgvMap.getStartRoute(),basRgvMap.getStartRoute());
+                    continue;
+//                    BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
+//                    Integer fallMerge = RouteUtils.RouteIndexFarMas(basRgvMap.getRgvNo(), basRgvMap.getEndRoute()); //鑾峰彇鍚堝苟骞叉秹椤�
+//                    List<Integer> route = RouteUtils.getRoute(basRgvMap.getStartRoute(),fallMerge);
+//                    List<WrkMastSta> wrkMastStaList = wrkMastStaMapper.selectNoInterfereList(route ,route);
+//                    if (!wrkMastStaList.isEmpty()){
+//                        log.info("灏忚溅瀛樺湪鍙墽琛屼换鍔★紝璺宠繃閬胯锛侊紒4214");
+//                        return;
+//                    }
+//                    if (rgvProtocol.getRgvPosI().equals(basRgvMap.getStartRoute())){
+////                    if (!RouteUtils.RgvRunStaSign(rgvProtocol.getRgvPosI(),RouteUtils.RouteIndexFarMas(rgvProtocol.getRgvNo(),rgvRunSta[rgvProtocol.getRgvNo()-1]),rgvProtocol.getRgvNo())){
+////                    if (!RouteUtils.RgvRunStaSign(rgvProtocol.getRgvPosI(),rgvRunSta[rgvProtocol.getRgvNo()-1],rgvProtocol.getRgvNo())){
+//                        if (rgvProtocol.getRgvNo()==1){
+//                            signRgv1 = false;
+//                        }else {
+//                            signRgv2 = false;
+//                        }
+//                    }
+//                    if (rgvProtocol.getRgvNo()==1 && (rgvProtocol.getRgvPosI().equals(101) || rgvProtocol.getRgvPosI().equals(102) )){
+//                        signRgv1 = false;
+//                        continue;
+//                    } else if (rgvProtocol.getRgvNo()==2 && (rgvProtocol.getRgvPosI().equals(116) || rgvProtocol.getRgvPosI().equals(117) ) ){
+//                        signRgv2 = false;
+//                        continue;
+//                    }
+                }else {
+                    signRgv = false;
+                    break;
                 }
             }
+//            if (signRgv &&  (signRgv1 || signRgv2)){
+//                for (RgvSlave rgvSlave:slaveProperties.getRgv()) {
+//                    RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgvSlave.getId());
+//                    RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
+//                    if (rgvProtocol == null) {
+//                        continue;
+//                    }
+//
+//                    // 鍙湁褰揜GV绌洪棽銆佽嚜鍔�,宸ヤ綅涓�鏃犵墿//rgv鍙敤
+//                    if (rgvProtocol.getStatusType() == RgvStatusType.IDLE
+//                            && rgvProtocol.getModeType() == RgvModeType.AUTO
+//                            && rgvProtocol.getLoaded1()==0  //鐜板満淇敼锛氬彔鐩樻満锛屼笉婊¢兘绠楁棤鐗╋紝鎬庝箞鍒ゆ柇闇�瑕佽窡鐢垫帶瀵规帴
+//                            && rgvProtocol.getTaskNo1()==0
+//                            && rgvProtocol.getTaskNo2()==0
+//                            && rgvProtocol.getStatusType1() == RgvStatusType.IDLE
+//                            && rgvProtocol.getStatusType2() == RgvStatusType.IDLE
+//                    ) {
+//                        if (rgvProtocol.getRgvNo()==1 && (rgvProtocol.getRgvPosI().equals(101) || rgvProtocol.getRgvPosI().equals(102) )){
+//                            continue;
+//                        } else if (rgvProtocol.getRgvNo()==2 && (rgvProtocol.getRgvPosI().equals(116) || rgvProtocol.getRgvPosI().equals(117) ) ){
+//                            continue;
+//                        }
+//                        BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
+//                        rgvAvoidanceXY(rgvProtocol.getRgvNo());
+//                        rgvMapUpdate(basRgvMap,basRgvMap.getStartRoute(),basRgvMap.getStartRoute());
+//
+//                    }
+//                }
+//            }
         }catch (Exception e){
             log.error("4109琛屾墽琛屽皬杞﹀垵濮嬪寲浠诲姟涓嬪彂澶辫触");
             log.error("4109琛�"+e);
@@ -4043,7 +4380,7 @@
                 rgvCommand.setTaskNo1((short)32222); // 宸ヤ綅1宸ヤ綔鍙�
                 rgvCommand.setTaskMode1(RgvTaskModeType.X_MOVE); // 宸ヤ綅1浠诲姟妯″紡:  鍥炲師鐐�
                 //basRgvMap.getLockStartRoute().shortValue()
-                rgvCommand.setSourceStaNo1( (short)101);
+                rgvCommand.setSourceStaNo1( (short)104);
                 rgvCommand.setCommand((short) 1);   //宸ヤ綅1浠诲姟纭
                 if (!MessageQueue.offer(SlaveType.Rgv, rgvId, new Task(4, rgvCommand))) {
                     //step=2,宸ヤ綅1銆�2鍐欎换鍔★紱   step=4锛屽伐浣�1鍐欎换鍔★紱     step=5锛屽伐浣�2鍐欎换鍔�   step=9锛屽洖鍘熺偣 9999浠诲姟鍙�
@@ -4065,7 +4402,7 @@
                 rgvCommand.setAckFinish2((short) 0);  // 宸ヤ綅2浠诲姟瀹屾垚纭浣�
                 rgvCommand.setTaskNo2((short)32222); // 宸ヤ綅2宸ヤ綔鍙�
                 rgvCommand.setTaskMode2(RgvTaskModeType.X_MOVE); // 宸ヤ綅2浠诲姟妯″紡:  鍥炲師鐐�
-                rgvCommand.setSourceStaNo2((short)117);
+                rgvCommand.setSourceStaNo2((short)114);
                 rgvCommand.setCommand((short) 2);   //宸ヤ綅2浠诲姟纭
                 if (!MessageQueue.offer(SlaveType.Rgv, rgvId, new Task(5, rgvCommand))) {
                     //step=2,宸ヤ綅1銆�2鍐欎换鍔★紱   step=4锛屽伐浣�1鍐欎换鍔★紱     step=5锛屽伐浣�2鍐欎换鍔�   step=9锛屽洖鍘熺偣 9999浠诲姟鍙�
@@ -4282,11 +4619,15 @@
      * 灏忚溅鍦板浘鏇存柊  鏇存柊閿�
      * */
     public synchronized boolean rgvMapUpdate(BasRgvMap basRgvMapCurrent,Integer staStart,Integer staEnd){
+        if (rgvOpen){
+            return true;
+        }
 
 //        List<Integer> integers = RouteUtils.RouteMapCurrentFar(basRgvMapCurrent.getNowRoute(),staStart,staEnd, basRgvMapCurrent.getLockStartRoute());
         //鏇存柊褰撳墠灏忚溅閿�
         try{
             Integer farCurrentStaNo = RouteUtils.RouteIndexFarMas(basRgvMapCurrent.getNowRoute(), staStart, staEnd, basRgvMapCurrent.getLockStartRoute());//鑾峰彇鏈�杩滅珯鐐�
+//            Integer farCurrentStaNo = RouteUtils.RouteIndexFarMas(staEnd, staStart, staEnd, basRgvMapCurrent.getLockStartRoute());//鑾峰彇鏈�杩滅珯鐐�
             Integer fallMerge = RouteUtils.RouteIndexFarMas(basRgvMapCurrent.getRgvNo(), farCurrentStaNo); //鑾峰彇鍚堝苟骞叉秹椤�
             basRgvMapCurrent.setLockEndRoute(fallMerge);
             basRgvMapMapper.updateById(basRgvMapCurrent);
@@ -4296,7 +4637,8 @@
             BasRgvMap basRgvMapOther = basRgvMapMapper.selectById(rgvNoOther);
             List<Integer> integers = RouteUtils.RouteMapCurrentFar(fallMerge, basRgvMapCurrent.getLockStartRoute());
             Integer lockEndRoute = RouteUtils.RouteMapOtherFarStnNo(integers, basRgvMapCurrent.getLockStartRoute());//鍙︿竴鍙板皬杞﹀彲娲诲姩鏈�杩滀綅缃�
-            basRgvMapOther.setEndRoute(lockEndRoute);
+            Integer lockEndRouteL = RouteUtils.RouteIndexFarMasL(rgvNoOther, lockEndRoute);//鍙︿竴鍙板皬杞﹀彲娲诲姩鏈�杩滀綅缃�
+            basRgvMapOther.setEndRoute(lockEndRouteL);
             basRgvMapMapper.updateById(basRgvMapOther);
             return true;
         }catch (Exception e){
@@ -4305,4 +4647,87 @@
         }
     }
 
+
+    /**
+     *  ste鍏呯數浠诲姟鍒涘缓   //瀹屾垚
+     */
+    public synchronized void armNoStartTwoLo() {
+        int[] staNos =new int[]{215,219};
+        for (int staNo : staNos){
+            try{
+                SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, 2);
+                StaProtocol staProtocol = devpThread.getStation().get(staNo);
+                if (staProtocol == null) {
+                    continue;
+                } else {
+                    staProtocol = staProtocol.clone();
+                }
+
+                if (staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.getWorkNo() == 0 && staProtocol.isPakMk()){
+                    RgvOneSign rgvOneSign = rgvOneSignMapper.selectOneSign("armNo"+staNo);
+                    if (!Cools.isEmpty(rgvOneSign) && rgvOneSign.getRgvOneSign() == 1){
+                        int workNo = commonService.getWorkNo(6);
+
+                        StaProtocol staProtocolnew = new StaProtocol();
+                        staProtocolnew.setSiteId(staNo);
+                        staProtocolnew.setWorkNo(workNo);
+                        staProtocolnew.setStaNo(staNo==215? 217:221);
+                        boolean result1 = MessageQueue.offer(SlaveType.Devp, 2, new Task(3, staProtocolnew));
+
+                        devpThread.setPakMk(staProtocolnew.getSiteId(), false);
+
+                        boolean result2 = MessageQueue.offer(SlaveType.Devp, 2, new Task(2, staProtocolnew));
+                        if (!result2) {
+                            log.error("鍙戝竷鍛戒护鑷宠緭閫佺嚎闃熷垪澶辫触锛侊紒锛� [plc缂栧彿锛歿}]", 2);
+                        }
+                        if (!staProtocol.isLoading()){
+                            updateRgvOneSign("armNo"+staNo,0);
+                        }
+
+
+                        boolean result3 = MessageQueue.offer(SlaveType.Devp, 2, new Task(4, staProtocolnew));
+                    }
+                }
+            }catch (Exception e){
+                log.error("绔欑偣"+staNo+"2妤兼満姊拌噦鐮佸灈鍚庢爣璁版竻闄ゅけ璐ワ紝寮傚父淇℃伅锛�"+e);
+            }
+        }
+    }
+
+    public synchronized void armNoCleanUpTwoLo() {
+        int[] staNos =new int[]{215,219};
+        for (int staNo : staNos){
+            try{
+                SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, 2);
+                StaProtocol staProtocol = devpThread.getStation().get(staNo);
+                if (staProtocol == null) {
+                    continue;
+                } else {
+                    staProtocol = staProtocol.clone();
+                }
+                if (!staProtocol.isLoading()){
+                    updateRgvOneSign("armNo"+staNo,0);
+                }
+            }catch (Exception e){
+                log.error("绔欑偣"+staNo+"2妤兼満姊拌噦鐮佸灈鍚庢爣璁版竻闄ゅけ璐ワ紝寮傚父淇℃伅锛�"+e);
+            }
+        }
+    }
+
+    public void updateRgvOneSign(String signType,Integer oneSign){
+        try{
+            RgvOneSign rgvOneSign = rgvOneSignMapper.selectOneSign(signType);
+            if (!Cools.isEmpty(rgvOneSign)){
+                rgvOneSign.setRgvOneSign(oneSign);
+                rgvOneSignMapper.updateById(rgvOneSign);
+            }
+        } catch (Exception e){
+            RgvOneSign rgvOneSign = rgvOneSignMapper.selectOneSign(signType);
+            if (!Cools.isEmpty(rgvOneSign)){
+                rgvOneSign.setRgvOneSign(999);
+                rgvOneSignMapper.updateById(rgvOneSign);
+            }
+        }
+    }
+
 }

--
Gitblit v1.9.1