From 0b6c8b7687ff593d254cfcacacf72a75bfdf11ca Mon Sep 17 00:00:00 2001
From: lty <876263681@qq.com>
Date: 星期二, 24 六月 2025 08:20:36 +0800
Subject: [PATCH] #限制线体上托盘数量

---
 src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java | 2810 ++++++++++++++++++++++++++---------------------------------
 1 files changed, 1,244 insertions(+), 1,566 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 7859cd6..c83491f 100644
--- a/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java
+++ b/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java
@@ -3,7 +3,6 @@
 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.exception.CoolException;
@@ -13,6 +12,7 @@
 import com.zy.asrs.utils.RouteUtils;
 import com.zy.asrs.utils.Utils;
 import com.zy.asrs.utils.VersionUtils;
+import com.zy.common.constant.GhjtApiConstant;
 import com.zy.common.model.LocTypeDto;
 import com.zy.common.model.MatDto;
 import com.zy.common.model.SearchLocParam;
@@ -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;
@@ -39,6 +38,8 @@
 import com.zy.core.thread.LedThread;
 import com.zy.core.thread.RgvThread;
 import com.zy.core.thread.SiemensDevpThread;
+import com.zy.system.entity.Config;
+import com.zy.system.mapper.ConfigMapper;
 import lombok.extern.slf4j.Slf4j;
 import org.springframework.beans.factory.annotation.Autowired;
 import org.springframework.beans.factory.annotation.Value;
@@ -46,7 +47,9 @@
 import org.springframework.transaction.annotation.Transactional;
 import org.springframework.transaction.interceptor.TransactionAspectSupport;
 
+import javax.annotation.Resource;
 import java.util.*;
+import java.util.concurrent.TimeUnit;
 import java.util.stream.Collectors;
 
 /**
@@ -98,6 +101,11 @@
     private WrkMastStaMapper wrkMastStaMapper;
     @Autowired
     private BasRgvMapMapper basRgvMapMapper;
+    @Autowired
+    private RgvOneSignMapper rgvOneSignMapper;
+
+    @Resource
+    private ConfigMapper configMapper;
 
     @Value("${wms.url}")
     private String wmsUrl;
@@ -135,6 +143,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;
                 }
 
                 // 鍏ュ嚭搴撴ā寮忓垽鏂�
@@ -323,7 +372,11 @@
 
                     // 鏇存柊绔欑偣淇℃伅 涓� 涓嬪彂plc鍛戒护
                     staProtocol.setWorkNo(wrkMast.getWrkNo());
-                    staProtocol.setStaNo(wrkMast.getStaNo());
+                    Integer staNo = wrkMast.getStaNo();
+                    if (wrkMast.getSourceStaNo()==145){
+                        staNo = 147;
+                    }
+                    staProtocol.setStaNo(staNo);
                     devpThread.setPakMk(staProtocol.getSiteId(), false);
                     boolean result = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
                     if (result) {
@@ -381,7 +434,7 @@
 
                 if (staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.isInEnable() && staProtocol.isPakMk()) {
 //                    WrkMast wrkMast = wrkMastMapper.selectPickStep(barcode);
-                    WrkMast wrkMast = wrkMastMapper.selectPakInStep3(staProtocol.getWorkNo());
+                    WrkMast wrkMast = wrkMastMapper.selectPakInStep5(staProtocol.getSiteId(),"7");
                     if (wrkMast == null) {
                         // 鏃犳嫞鏂欐暟鎹�
                         continue;
@@ -391,73 +444,67 @@
                         continue;
                     }
 
-                    // 鎷c�佺洏銆佸苟 浣滀笟绔欒浆鎹�
-//                    int stnNo = 0;
-//                    if (wrkMast.getStaNo() == 109) {
-//                        stnNo = 127;
-//                    } else if (wrkMast.getStaNo() == 113) {
-//                        stnNo = 128;
-//                    } else {
-//                        log.error("{}鍙蜂换鍔℃暟鎹紓甯革紒", wrkMast.getWrkNo());
-//                    }
-                    // 鑾峰彇鐩爣绔�
-                    Wrapper<StaDesc> wrapper = new EntityWrapper<StaDesc>()
-                            .eq("type_no", wrkMast.getIoType() - 50)
-                            .eq("stn_no", pickSta.getStaNo()) // 浣滀笟绔欑偣 = 鎷f枡鍑哄簱鐨勭洰鏍囩珯
-                            .eq("crn_no", wrkMast.getCrnNo()); // 鍫嗗灈鏈哄彿
-                    StaDesc staDesc = staDescService.selectOne(wrapper);
-                    if (Cools.isEmpty(staDesc)) {
-                        log.error("鍏ュ簱璺緞涓嶅瓨鍦紒type_no={},stn_no={},crn_no={}", wrkMast.getIoType(), pickSta.getStaNo(), wrkMast.getCrnNo());
-                        continue;
-                    }
-
+                    //   鑾峰彇搴撲綅鍙�
                     try {
-                        // 淇濆瓨宸ヤ綔鏄庣粏妗e巻鍙叉。
-                        if (wrkMastMapper.saveWrkDetlLog(wrkMast.getWrkNo()) == 0) {
-                            throw new CoolException("淇濆瓨宸ヤ綔鏄庣粏妗e巻鍙叉。澶辫触");
+                        SearchLocParam param = new SearchLocParam();
+                        param.setBarcode(wrkMast.getBarcode());
+                        param.setIoType(wrkMast.getIoType());
+                        param.setSourceStaNo(pickSta.getStaNo()); //浣滀笟绔欑偣
+                        param.setLocType1((short)1);
+                        String response = "";
+                        log.info("鍏ュ簱浣滀笟绔�"+pickSta.getStaNo()+"鐩樼偣鍐嶅叆搴撲换鍔¤姹俉MS===>>鍙傛暟锛�" + param);
+                        try {
+                            response = new HttpHandler.Builder()
+                                    .setUri(wmsUrl)
+                                    .setPath("/rpc/pakin2/loc/v1")
+                                    .setJson(JSON.toJSONString(param))
+                                    .setTimeout(15, TimeUnit.SECONDS)
+                                    .build()
+                                    .doPost();
+                        } catch(Exception e){
+                            log.error("鍏ュ簱浣滀笟绔�"+pickSta.getStaNo()+"鐩樼偣鍐嶅叆搴撲换鍔¤姹俉MS===>>鍙傛暟锛�" + param);
+                            log.error("stnToCrnStnPick2===>>鐩樼偣鏌ュ簱浣嶅叆搴撴帴鍙eけ璐�", e);
+                            e.printStackTrace();
+                            continue;
                         }
-                        // 淇濆瓨宸ヤ綔涓绘。鍘嗗彶妗�
-                        if (wrkMastMapper.saveWrkMastLog(wrkMast.getWrkNo()) == 0) {
-                            throw new CoolException("淇濆瓨宸ヤ綔涓绘。鍘嗗彶妗eけ璐�");
+                        log.info("鍏ュ簱浣滀笟绔�"+pickSta.getStaNo()+"鐩樼偣鍐嶅叆搴撲换鍔¤姹俉MS===>>鍙傛暟锛�" + param);
+                        log.info("鍏ュ簱浣滀笟绔�"+pickSta.getStaNo()+"涓嬪彂鐩樼偣鍐嶅叆搴撲换鍔¤姹俉MS杩斿洖缁撴灉===>>" + response);
+                        if(response.equals("")) {
+                            continue;
                         }
-
-                        Date now = new Date();
-                        // 鍫嗗灈鏈虹珯鐐�(鐩爣绔�)
-                        Integer staNo = staDesc.getCrnStn();
-                        // 鏇存柊宸ヤ綔妗f暟鎹姸鎬�
-                        wrkMast.setIoTime(now);
-                        wrkMast.setIoType(wrkMast.getIoType() - 50); // 鍏ュ嚭搴撶被鍨�: 103->53,104->54,107->57
-                        wrkMast.setWrkSts(2L); // 宸ヤ綔鐘舵��: 2.璁惧涓婅蛋
-                        wrkMast.setSourceStaNo(wrkMast.getStaNo()); // 婧愮珯
-                        wrkMast.setStaNo(staNo); // 鐩爣绔�
-                        wrkMast.setLocNo(wrkMast.getSourceLocNo()); // 鐩爣搴撲綅 = 鍑哄簱鏃剁殑婧愬簱浣�
-                        wrkMast.setSourceLocNo(""); // 婧愬簱浣嶆竻绌�
-                        wrkMast.setModiTime(now);
-                        if (wrkMastMapper.updateById(wrkMast) == 0) {
-                            throw new CoolException("鏇存柊宸ヤ綔妗f暟鎹姸鎬佸け璐�");
-                        }
-                        // 鏇存柊鏄庣粏妗o_time (鍘嗗彶妗e叧鑱斾娇鐢級
-                        wrkDetlService.updateIoTime(wrkMast.getWrkNo(), now);
-                        // 淇敼搴撲綅鐘舵�� Q.鎷f枡/鐩樼偣/骞舵澘鍐嶅叆搴�
-                        LocMast locMast = locMastService.selectById(wrkMast.getLocNo());
-                        locMast.setLocSts("Q");
-                        locMast.setModiTime(new Date());
-                        if (!locMastService.updateById(locMast)) {
-                            throw new CoolException("淇敼搴撲綅鐘舵�佸け璐�");
+                        JSONObject jsonObject = JSON.parseObject(response);
+//                        LedThread ledThread = (LedThread) SlaveConnection.get(SlaveType.Led, pickSta.getLed());
+                        Integer code = jsonObject.getInteger("code");
+                        if (code == 200) {
+                            StartupDto dto = jsonObject.getObject("data", StartupDto.class);
+                            if (Cools.isEmpty(dto) || Cools.isEmpty(dto.getStaNo())) {
+                                log.error("浠诲姟鍙�"+wrkMast.getWrkNo()+"鐩樼偣鍐嶅叆搴撴煡璇㈠簱浣嶅け璐�===>>" + jsonObject.toJSONString());
+                            } else {
+                                log.info("浠诲姟鍙�"+wrkMast.getWrkNo()+"鐩樼偣鍐嶅叆搴撴煡璇㈠簱浣嶆垚鍔�===>>" + jsonObject.toJSONString());
+                                try {
+                                    // 鏇存柊绔欑偣淇℃伅 涓� 涓嬪彂plc鍛戒护
+                                    staProtocol.setWorkNo(wrkMast.getWrkNo());
+                                    staProtocol.setStaNo(dto.getStaNo());
+                                    devpThread.setPakMk(staProtocol.getSiteId(), false);
+//                                    ledThread.errorReset();
+                                    boolean result = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
+                                    if (!result) {
+                                        log.error("鍙戝竷鍛戒护鑷宠緭閫佺嚎闃熷垪澶辫触锛侊紒锛� [plc缂栧彿锛歿}]", devp.getId());
+                                    }
+                                    log.info("浠诲姟鍙�"+wrkMast.getWrkNo()+"鐩樼偣/鎷f枡鍐嶅叆搴撲换鍔′笅鍙戞垚鍔�===>>" + staProtocol);
+                                } catch (Exception e) {
+                                    log.error("鐩樼偣鍐嶅叆搴撳け璐�===>>" + e);
+                                    e.printStackTrace();
+                                    TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
+                                }
+                            }
+                        } else {
+                            log.error("璇锋眰鎺ュ彛澶辫触锛侊紒锛乽rl锛歿}锛況equest锛歿}锛況esponse锛歿}", wmsUrl + "/rpc/pakin2/loc/v1", JSON.toJSONString(param), response);
                         }
                     } catch (Exception e) {
+                        log.error("stnToCrnStnPick2===>>fail", e);
                         e.printStackTrace();
                         TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
-                        continue;
-                    }
-
-                    // 鏇存柊绔欑偣淇℃伅 涓� 涓嬪彂plc鍛戒护
-                    staProtocol.setWorkNo(wrkMast.getWrkNo());
-                    staProtocol.setStaNo(wrkMast.getStaNo());
-                    devpThread.setPakMk(staProtocol.getSiteId(), false);
-                    boolean result = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
-                    if (!result) {
-                        log.error("鍙戝竷鍛戒护鑷宠緭閫佺嚎闃熷垪澶辫触锛侊紒锛� [plc缂栧彿锛歿}]", devp.getId());
                     }
 
                 }
@@ -492,19 +539,6 @@
                     WrkMast wrkMast = wrkMastMapper.selectPakInStep4(staProtocol.getSiteId(),"3");
 
                     if (wrkMast == null) {
-//                        WrkMast wrkMast1 = wrkMastMapper.selectPakInStep5(staProtocol.getSiteId(),"3");
-//                        if (Cools.isEmpty(wrkMast1) && staProtocol.isEmptyMk()){
-//                            WrkMastSta wrkMastSta = wrkMastStaMapper.selectByWrkNo(staProtocol.getSiteId() + 9999L);
-//                            if (Cools.isEmpty(wrkMastSta)){
-//                                WrkMastSta wrkMastSta1 = new WrkMastSta(new Date(),staProtocol.getSiteId());
-//                                wrkMastSta1.setType(2);
-//                                wrkMastSta1.setWrkType(1);
-//                                wrkMastStaMapper.insert(wrkMastSta1);
-//                            }
-//                            continue;
-//                        }
-//                        log.error("绔欑偣鍙�"+staProtocol.getSiteId()+"鏈煡璇㈠埌宸ヤ綔妗f锛�");
-                        // 鏃犳嫞鏂欐暟鎹�
                         continue;
                     }
                     if (staProtocol.isEmptyMk()){
@@ -516,65 +550,137 @@
                         continue;
                     }
 
-                    // 鑾峰彇鐩爣绔�
-                    Wrapper<StaDesc> wrapper = new EntityWrapper<StaDesc>()
-                            .eq("type_no", wrkMast.getIoType() - 50)
-                            .eq("stn_no", pickSta.getStaNo()) // 浣滀笟绔欑偣 = 鎷f枡鍑哄簱鐨勭洰鏍囩珯
-                            .eq("crn_no", wrkMast.getCrnNo()); // 鍫嗗灈鏈哄彿
-                    StaDesc staDesc = staDescService.selectOne(wrapper);
-                    if (Cools.isEmpty(staDesc)) {
-                        log.error("鍏ュ簱璺緞涓嶅瓨鍦紒type_no={},stn_no={},crn_no={}", wrkMast.getIoType(), pickSta.getStaNo(), wrkMast.getCrnNo());
+                    String barcode = wrkMast.getBarcode();
+                    if(!Cools.isEmpty(barcode)) {
+                        if("NG".endsWith(barcode) || "NoRead".equals(barcode) || "empty".equals(barcode)) {
+                            continue;
+                        }
+                    } else {
                         continue;
                     }
 
+                    //   鑾峰彇搴撲綅鍙�
                     try {
-                        // 淇濆瓨宸ヤ綔鏄庣粏妗e巻鍙叉。
-                        if (wrkMastMapper.saveWrkDetlLog(wrkMast.getWrkNo()) == 0) {
-                            throw new CoolException("淇濆瓨宸ヤ綔鏄庣粏妗e巻鍙叉。澶辫触");
+                        SearchLocParam param = new SearchLocParam();
+                        param.setBarcode(barcode);
+                        param.setIoType(wrkMast.getIoType());
+                        param.setSourceStaNo(pickSta.getStaNo()); //浣滀笟绔欑偣
+                        param.setLocType1((short)1);
+                        String response = "";
+                        log.info("鍏ュ簱浣滀笟绔�"+pickSta.getStaNo()+"鐩樼偣鍐嶅叆搴撲换鍔¤姹俉MS===>>鍙傛暟锛�" + param);
+                        try {
+                            response = new HttpHandler.Builder()
+                                    .setUri(wmsUrl)
+                                    .setPath("/rpc/pakin2/loc/v1")
+                                    .setJson(JSON.toJSONString(param))
+                                    .setTimeout(15, TimeUnit.SECONDS)
+                                    .build()
+                                    .doPost();
+                        } catch(Exception e){
+                            log.error("鍏ュ簱浣滀笟绔�"+pickSta.getStaNo()+"鐩樼偣鍐嶅叆搴撲换鍔¤姹俉MS===>>鍙傛暟锛�" + param);
+                            log.error("stnToCrnStnPick2===>>鐩樼偣鏌ュ簱浣嶅叆搴撴帴鍙eけ璐�", e);
+                            e.printStackTrace();
+                            continue;
                         }
-                        // 淇濆瓨宸ヤ綔涓绘。鍘嗗彶妗�
-                        if (wrkMastMapper.saveWrkMastLog(wrkMast.getWrkNo()) == 0) {
-                            throw new CoolException("淇濆瓨宸ヤ綔涓绘。鍘嗗彶妗eけ璐�");
+                        log.info("鍏ュ簱浣滀笟绔�"+pickSta.getStaNo()+"鐩樼偣鍐嶅叆搴撲换鍔¤姹俉MS===>>鍙傛暟锛�" + param);
+                        log.info("鍏ュ簱浣滀笟绔�"+pickSta.getStaNo()+"涓嬪彂鐩樼偣鍐嶅叆搴撲换鍔¤姹俉MS杩斿洖缁撴灉===>>" + response);
+                        if(response.equals("")) {
+                            continue;
                         }
-
-                        Date now = new Date();
-                        // 鍫嗗灈鏈虹珯鐐�(鐩爣绔�)
-                        Integer staNo = staDesc.getCrnStn();
-                        // 鏇存柊宸ヤ綔妗f暟鎹姸鎬�
-                        wrkMast.setIoTime(now);
-                        wrkMast.setIoType(wrkMast.getIoType() - 50); // 鍏ュ嚭搴撶被鍨�: 103->53,104->54,107->57
-                        wrkMast.setWrkSts(2L); // 宸ヤ綔鐘舵��: 2.璁惧涓婅蛋
-                        wrkMast.setSourceStaNo(wrkMast.getStaNo()); // 婧愮珯
-                        wrkMast.setStaNo(staNo); // 鐩爣绔�
-                        wrkMast.setLocNo(wrkMast.getSourceLocNo()); // 鐩爣搴撲綅 = 鍑哄簱鏃剁殑婧愬簱浣�
-                        wrkMast.setSourceLocNo(""); // 婧愬簱浣嶆竻绌�
-                        wrkMast.setModiTime(now);
-                        if (wrkMastMapper.updateById(wrkMast) == 0) {
-                            throw new CoolException("鏇存柊宸ヤ綔妗f暟鎹姸鎬佸け璐�");
-                        }
-                        // 鏇存柊鏄庣粏妗o_time (鍘嗗彶妗e叧鑱斾娇鐢級
-                        wrkDetlService.updateIoTime(wrkMast.getWrkNo(), now);
-                        // 淇敼搴撲綅鐘舵�� Q.鎷f枡/鐩樼偣/骞舵澘鍐嶅叆搴�
-                        LocMast locMast = locMastService.selectById(wrkMast.getLocNo());
-                        locMast.setLocSts("Q");
-                        locMast.setModiTime(new Date());
-                        if (!locMastService.updateById(locMast)) {
-                            throw new CoolException("淇敼搴撲綅鐘舵�佸け璐�");
+                        JSONObject jsonObject = JSON.parseObject(response);
+//                        LedThread ledThread = (LedThread) SlaveConnection.get(SlaveType.Led, pickSta.getLed());
+                        Integer code = jsonObject.getInteger("code");
+                        if (code == 200) {
+                            StartupDto dto = jsonObject.getObject("data", StartupDto.class);
+                            if (Cools.isEmpty(dto) || Cools.isEmpty(dto.getStaNo())) {
+                                log.error("浠诲姟鍙�"+wrkMast.getWrkNo()+"鐩樼偣鍐嶅叆搴撴煡璇㈠簱浣嶅け璐�===>>" + jsonObject.toJSONString());
+                            } else {
+                                log.info("浠诲姟鍙�"+wrkMast.getWrkNo()+"鐩樼偣鍐嶅叆搴撴煡璇㈠簱浣嶆垚鍔�===>>" + jsonObject.toJSONString());
+                                try {
+                                    // 鏇存柊绔欑偣淇℃伅 涓� 涓嬪彂plc鍛戒护
+                                    staProtocol.setWorkNo(wrkMast.getWrkNo());
+                                    staProtocol.setStaNo(dto.getStaNo());
+                                    devpThread.setPakMk(staProtocol.getSiteId(), false);
+//                                    ledThread.errorReset();
+                                    boolean result = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
+                                    if (!result) {
+                                        log.error("鍙戝竷鍛戒护鑷宠緭閫佺嚎闃熷垪澶辫触锛侊紒锛� [plc缂栧彿锛歿}]", devp.getId());
+                                    }
+                                    log.info("浠诲姟鍙�"+wrkMast.getWrkNo()+"鐩樼偣/鎷f枡鍐嶅叆搴撲换鍔′笅鍙戞垚鍔�===>>" + staProtocol);
+                                } catch (Exception e) {
+                                    log.error("鐩樼偣鍐嶅叆搴撳け璐�===>>" + e);
+                                    e.printStackTrace();
+                                    TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
+                                }
+                            }
+                        } else {
+                            log.error("璇锋眰鎺ュ彛澶辫触锛侊紒锛乽rl锛歿}锛況equest锛歿}锛況esponse锛歿}", wmsUrl + "/rpc/pakin2/loc/v1", JSON.toJSONString(param), response);
                         }
                     } catch (Exception e) {
+                        log.error("stnToCrnStnPick2===>>fail", e);
                         e.printStackTrace();
                         TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
-                        continue;
                     }
 
-                    // 鏇存柊绔欑偣淇℃伅 涓� 涓嬪彂plc鍛戒护
-                    staProtocol.setWorkNo(wrkMast.getWrkNo());
-                    staProtocol.setStaNo(wrkMast.getStaNo());
-                    devpThread.setPakMk(staProtocol.getSiteId(), false);
-                    boolean result = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
-                    if (!result) {
-                        log.error("鍙戝竷鍛戒护鑷宠緭閫佺嚎闃熷垪澶辫触锛侊紒锛� [plc缂栧彿锛歿}]", devp.getId());
-                    }
+//                    // 鑾峰彇鐩爣绔�
+//                    Wrapper<StaDesc> wrapper = new EntityWrapper<StaDesc>()
+//                            .eq("type_no", wrkMast.getIoType() - 50)
+//                            .eq("stn_no", pickSta.getStaNo()) // 浣滀笟绔欑偣 = 鎷f枡鍑哄簱鐨勭洰鏍囩珯
+//                            .eq("crn_no", wrkMast.getCrnNo()); // 鍫嗗灈鏈哄彿
+//                    StaDesc staDesc = staDescService.selectOne(wrapper);
+//                    if (Cools.isEmpty(staDesc)) {
+//                        log.error("鍏ュ簱璺緞涓嶅瓨鍦紒type_no={},stn_no={},crn_no={}", wrkMast.getIoType(), pickSta.getStaNo(), wrkMast.getCrnNo());
+//                        continue;
+//                    }
+//
+//                    try {
+//                        // 淇濆瓨宸ヤ綔鏄庣粏妗e巻鍙叉。
+//                        if (wrkMastMapper.saveWrkDetlLog(wrkMast.getWrkNo()) == 0) {
+//                            throw new CoolException("淇濆瓨宸ヤ綔鏄庣粏妗e巻鍙叉。澶辫触");
+//                        }
+//                        // 淇濆瓨宸ヤ綔涓绘。鍘嗗彶妗�
+//                        if (wrkMastMapper.saveWrkMastLog(wrkMast.getWrkNo()) == 0) {
+//                            throw new CoolException("淇濆瓨宸ヤ綔涓绘。鍘嗗彶妗eけ璐�");
+//                        }
+//
+//                        Date now = new Date();
+//                        // 鍫嗗灈鏈虹珯鐐�(鐩爣绔�)
+//                        Integer staNo = staDesc.getCrnStn();
+//                        // 鏇存柊宸ヤ綔妗f暟鎹姸鎬�
+//                        wrkMast.setIoTime(now);
+//                        wrkMast.setIoType(wrkMast.getIoType() - 50); // 鍏ュ嚭搴撶被鍨�: 103->53,104->54,107->57
+//                        wrkMast.setWrkSts(2L); // 宸ヤ綔鐘舵��: 2.璁惧涓婅蛋
+//                        wrkMast.setSourceStaNo(wrkMast.getStaNo()); // 婧愮珯
+//                        wrkMast.setStaNo(staNo); // 鐩爣绔�
+//                        wrkMast.setLocNo(wrkMast.getSourceLocNo()); // 鐩爣搴撲綅 = 鍑哄簱鏃剁殑婧愬簱浣�
+//                        wrkMast.setSourceLocNo(""); // 婧愬簱浣嶆竻绌�
+//                        wrkMast.setModiTime(now);
+//                        if (wrkMastMapper.updateById(wrkMast) == 0) {
+//                            throw new CoolException("鏇存柊宸ヤ綔妗f暟鎹姸鎬佸け璐�");
+//                        }
+//                        // 鏇存柊鏄庣粏妗o_time (鍘嗗彶妗e叧鑱斾娇鐢級
+//                        wrkDetlService.updateIoTime(wrkMast.getWrkNo(), now);
+//                        // 淇敼搴撲綅鐘舵�� Q.鎷f枡/鐩樼偣/骞舵澘鍐嶅叆搴�
+//                        LocMast locMast = locMastService.selectById(wrkMast.getLocNo());
+//                        locMast.setLocSts("Q");
+//                        locMast.setModiTime(new Date());
+//                        if (!locMastService.updateById(locMast)) {
+//                            throw new CoolException("淇敼搴撲綅鐘舵�佸け璐�");
+//                        }
+//                    } catch (Exception e) {
+//                        e.printStackTrace();
+//                        TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
+//                        continue;
+//                    }
+//
+//                    // 鏇存柊绔欑偣淇℃伅 涓� 涓嬪彂plc鍛戒护
+//                    staProtocol.setWorkNo(wrkMast.getWrkNo());
+//                    staProtocol.setStaNo(wrkMast.getStaNo());
+//                    devpThread.setPakMk(staProtocol.getSiteId(), false);
+//                    boolean result = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
+//                    if (!result) {
+//                        log.error("鍙戝竷鍛戒护鑷宠緭閫佺嚎闃熷垪澶辫触锛侊紒锛� [plc缂栧彿锛歿}]", devp.getId());
+//                    }
 
                 }
 
@@ -583,6 +689,164 @@
         }
     }
 
+    /**
+     * 2妤�212鍛煎彨绌烘澘
+     */
+    public synchronized void stnToCrnStnPick3Auto(Integer sign) {
+        try{
+            SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, 2);
+            StaProtocol staProtocol = devpThread.getStation().get(212);
+            if (staProtocol == null) {
+                return;
+            } else {
+                staProtocol = staProtocol.clone();
+            }
+            if (staProtocol.isAutoing() && !staProtocol.isLoading() && staProtocol.getWorkNo()==0 ){
+                switch (sign){
+                    //鎵ц灏忚溅璐х墿鎼繍浠诲姟
+                    case 1:
+                    case 4:
+                        stnToCrnStnPick3();
+                        return;
+                    //鎵ц灏忚溅绌烘澘鎼繍浠诲姟
+                    case 2://鏀�//鎷嗙洏
+                    case 5://鏀�//鎷嗙洏
+                        stnToCrnStnPick4();
+                        return;
+                    default:
+                        return;
+                }
+            } else if (staProtocol.isAutoing() && staProtocol.isLoading()){
+                switch (sign){
+                    case 3://婊℃斁
+                    case 6://婊℃斁
+                        stnToCrnStnPick5();
+                        return;
+                    default:
+                        return;
+                }
+            }
+        }catch (Exception e){
+            log.error("2妤�212鍛煎彨绌烘澘"+e);
+        }
+    }
+    /**
+     * 2妤�212鍛煎彨绌烘澘
+     */
+    public synchronized void stnToCrnStnPick3() {
+        WrkMast wrkMast = wrkMastMapper.selectWrkMastUnstackingOne212();
+        if (Cools.isEmpty(wrkMast) || wrkMast.getWrkSts()!=61){//61銆佺瓑寰呯┖鏉�
+            return;
+        }
+        for (DevpSlave devp : slaveProperties.getDevp()) {
+            for (DevpSlave.Sta driveSta : devp.getDriveSta()) {
+                if (driveSta.getStaNo()!=215){
+                    continue;
+                }
+                // 鑾峰彇鎷f枡鍏ュ簱绔欎俊鎭�
+                SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, devp.getId());
+                StaProtocol staProtocol = devpThread.getStation().get(driveSta.getStaNo());
+                if (staProtocol == null) {
+                    continue;
+                } else {
+                    staProtocol = staProtocol.clone();
+                }
+                if (staProtocol.isAutoing() && staProtocol.isLoading() && (staProtocol.getWorkNo()==0
+                        || (staProtocol.getWorkNo()>9899 && staProtocol.getWorkNo()<10000)) ){
+                    boolean result1 = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(3, staProtocol));
+
+                    staProtocol.setWorkNo(wrkMast.getWrkNo()-1);
+                    staProtocol.setStaNo(driveSta.getStaNo()==215? 217:221);
+                    boolean result2 = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
+                    if (!result2) {
+                        log.error("鍙戝竷鍛戒护鑷宠緭閫佺嚎闃熷垪澶辫触锛侊紒锛� [plc缂栧彿锛歿}]", devp.getId());
+                    }
+                    wrkMast.setWrkSts(62L);
+                    wrkMastMapper.updateById(wrkMast);
+
+                    boolean result3 = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(4, staProtocol));
+                    return;
+                }
+            }
+        }
+    }
+
+    /**
+     * 2妤�212鍛煎彨绌烘澘
+     */
+    public synchronized void stnToCrnStnPick4() {
+        WrkMast wrkMast = wrkMastMapper.selectWrkMastUnstackingOne212();
+        if (Cools.isEmpty(wrkMast) || wrkMast.getWrkSts()!=62){//62銆佺瓑寰呭皬杞︽惉杩�
+            return;
+        }
+        for (DevpSlave devp : slaveProperties.getDevp()) {
+            for (DevpSlave.Sta driveSta : devp.getInSta()) {
+                if (driveSta.getStaNo()!=217){
+                    continue;
+                }
+                // 鑾峰彇鎷f枡鍏ュ簱绔欎俊鎭�
+                SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, devp.getId());
+                StaProtocol staProtocol = devpThread.getStation().get(driveSta.getStaNo());
+                if (staProtocol == null) {
+                    continue;
+                } else {
+                    staProtocol = staProtocol.clone();
+                }
+                StaProtocol staProtocol212 = devpThread.getStation().get(212);
+                if (staProtocol212 == null) {
+                    continue;
+                } else {
+                    staProtocol212 = staProtocol212.clone();
+                }
+                if (staProtocol212.isAutoing() && !staProtocol212.isLoading() && staProtocol212.getWorkNo()==0){
+                    if (staProtocol.isAutoing() && staProtocol.isLoading() && (staProtocol.getWorkNo()==0
+                            || (staProtocol.getWorkNo()>9899 && staProtocol.getWorkNo()<10000) || staProtocol.getWorkNo()==wrkMast.getWrkNo()-1) ){
+//                        boolean result1 = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(3, staProtocol));
+
+                        staProtocol.setWorkNo(wrkMast.getWrkNo());
+                        staProtocol.setStaNo(212);
+                        boolean result2 = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
+                        if (!result2) {
+                            log.error("鍙戝竷鍛戒护鑷宠緭閫佺嚎闃熷垪澶辫触锛侊紒锛� [plc缂栧彿锛歿}]", devp.getId());
+                        }
+                        wrkMast.setWrkSts(63L);
+                        wrkMastMapper.updateById(wrkMast);
+
+//                        boolean result3 = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(4, staProtocol));
+                        return;
+                    }
+                }
+            }
+        }
+    }
+
+    /**
+     * 2妤�212鍛煎彨绌烘澘
+     */
+    public synchronized void stnToCrnStnPick5() {
+        WrkMast wrkMast = wrkMastMapper.selectWrkMastUnstackingOne212();
+        if (Cools.isEmpty(wrkMast) || wrkMast.getWrkSts()!=63){//63銆佺瓑寰呭畬鎴�
+            return;
+        }
+
+        // 鑾峰彇鎷f枡鍏ュ簱绔欎俊鎭�
+        SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, 2);
+        StaProtocol staProtocol = devpThread.getStation().get(212);
+        if (staProtocol == null) {
+            return;
+        } else {
+            staProtocol = staProtocol.clone();
+        }
+        if (staProtocol.isAutoing() && staProtocol.isLoading()){
+//            boolean result1 = MessageQueue.offer(SlaveType.Devp, 2, new Task(3, staProtocol));
+
+            wrkMast.setWrkSts(64L);
+            wrkMastMapper.updateById(wrkMast);
+
+//            boolean result3 = MessageQueue.offer(SlaveType.Devp, 2, new Task(4, staProtocol));
+            return;
+        }
+    }
     /**
      * 鎷f枡銆佸苟鏉裤�佺洏鐐瑰啀鍏ュ簱  鎷嗗灈浣嶇疆
      */
@@ -617,6 +881,48 @@
                                 wrkMastStaMapper.insert(wrkMastSta1);
                             }
                         }
+                    }
+                }
+            }
+        }
+    }
+    /**
+     * 鍫嗗灈鏈虹珯鍑哄簱鍒板嚭搴撶珯
+     */
+    public synchronized void crnStnToOutStn1() {
+        for (CrnSlave crnSlave : slaveProperties.getCrn()) {
+            // 閬嶅巻鍫嗗灈鏈哄嚭搴撶珯
+            for (CrnSlave.CrnStn crnStn : crnSlave.getCrnOutStn()) {
+                // 鏌ヨ宸ヤ綔妗�
+                WrkMast wrkMast = wrkMastMapper.selectPakOutStep2(crnStn.getStaNo());
+                if (wrkMast == null) {
+                    continue;
+                }
+                // 鍒ゆ柇宸ヤ綔妗f潯浠�
+                if ((wrkMast.getIoType() < 100 && wrkMast.getIoType() != 12) || wrkMast.getStaNo() == null || wrkMast.getSourceStaNo() == null) {
+                    continue;
+                }
+                // 鍒ゆ柇鍚婅溅鏄惁瀹為檯宸插畬鎴愶紝涓旂數鑴戠姸鎬佸湪move涓紝浠ュ鐢佃剳杩涜鏇存柊宸ヤ綔妗�
+                CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn, wrkMast.getCrnNo());
+                CrnProtocol crnProtocol = crnThread.getCrnProtocol();
+                if (crnProtocol.statusType == CrnStatusType.FETCHING || crnProtocol.statusType == CrnStatusType.PUTTING) {
+                    // 绉诲姩涓�
+                    continue;
+                }
+                //  鍒ゆ柇鍫嗗灈鏈虹姸鎬佺瓑寰呯‘璁�
+                if (crnProtocol.modeType == CrnModeType.AUTO && crnProtocol.getTaskNo().equals(wrkMast.getWrkNo().shortValue())
+                        && crnProtocol.statusType == CrnStatusType.WAITING
+                        && crnProtocol.forkPosType == CrnForkPosType.HOME) {
+
+                    // 鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
+                    // 鏇存柊宸ヤ綔妗g姸鎬佷负14
+                    wrkMast.setWrkSts(13L);
+                    wrkMast.setCrnEndTime(new Date());
+                    if (wrkMastMapper.updateById(wrkMast) != 0) {
+                        // 澶嶄綅鍫嗗灈鏈�
+                        crnThread.setResetFlag(true);
+                    } else {
+                        log.error("鏇存柊宸ヤ綔妗g殑宸ヤ綔鐘舵�佷负14澶辫触锛侊紒锛� [宸ヤ綔鍙�:{}]", wrkMast.getWrkNo());
                     }
                 }
             }
@@ -804,607 +1110,6 @@
             log.error("鎼滅储RGV杞︺�傞�氳繃鐩爣绔欐悳绱㈠摢鍙拌溅鍙敤"+e);
             return null;
         }
-    }
-
-//    /**
-//     * 缁戝畾灏忚溅鏂规硶
-//     */
-//    public synchronized void rgvBindSte() {
-//        //鑾峰彇绛夊緟缁戝畾RGV鐨勪换鍔�
-//        List<WrkMast> wrkMasts = wrkMastMapper.selectWaitBindRGV();
-//        for (WrkMast wrkMast : wrkMasts) {
-//            //鐩爣绔�
-//            Integer staNo = wrkMast.getStaNo();
-//            //婧愮珯
-//            Integer sourceStaNo = wrkMast.getSourceStaNo();
-//            //閫氳繃鐩爣绔欐悳绱gv鍙�
-//            Integer rgvNo=0;
-//            if (wrkMast.getCrnNo()==1){
-//                rgvNo=1;
-//            }else if (wrkMast.getCrnNo()==6){
-//                rgvNo=2;
-//            }else {
-//                rgvNo = this.searchRgvNo(staNo);
-//            }
-//            if (rgvNo == null || rgvNo==0) {//鏈壘鍒板彲鐢ㄧ殑rgv
-//                continue;
-//            }
-//
-//            wrkMast.setRgvNo(rgvNo);//缁戝畾rgv鍙�
-//            wrkMast.setRgvDstaNo(wrkMast.getSourceStaNo());//璁剧疆RGV鍓嶅線宸ヤ綔妗f簮绔欏彇璐�
-//            if (wrkMastMapper.updateById(wrkMast)==0){
-//                log.error("缁戝畾灏忚溅鏇存柊宸ヤ綔妗eけ璐ワ紒锛侊紒 [宸ヤ綔鍙凤細{}]", wrkMast.getWrkNo());
-//            }
-//        }
-//    }
-
-    /**
-     * 缁戝畾灏忚溅鏂规硶
-     */
-    public synchronized void rgvBindSte() {
-        try {
-            // 鏍规嵁杈撻�佺嚎plc閬嶅巻
-            for (DevpSlave devp : slaveProperties.getDevp()) {
-                if (devp.getId()==2){
-                    continue;
-                }
-                SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, devp.getId());
-                //鍏ュ簱缁戝皬杞�
-                for (DevpSlave.Sta Sta : devp.getInRgvSta()) {
-                    StaProtocol staProtocol = devpThread.getStation().get(Sta.getStaNo());
-                    if (staProtocol == null) {
-                        continue;
-                    } else {
-                        staProtocol = staProtocol.clone();
-                    }
-                    if (staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.getWorkNo() != 0 && staProtocol.getWorkNo() < 9990){
-                        List<WrkMast> wrkMasts = wrkMastMapper.selectList(new EntityWrapper<WrkMast>().eq("wrk_no", staProtocol.getWorkNo()).eq("wrk_sts", 2L));
-                        if (Cools.isEmpty(wrkMasts) || wrkMasts.size()!=1){
-                            continue;
-                        }
-                        WrkMast wrkMast = wrkMasts.get(0);
-                                    //鐩爣绔�
-                        Integer staNo = wrkMast.getStaNo();
-                        //閫氳繃鐩爣绔欐悳绱gv鍙�
-                        Integer rgvNo=0;
-                        if (wrkMast.getCrnNo()==1){
-                            rgvNo=1;
-                        }else if (wrkMast.getCrnNo()==6){
-                            rgvNo=2;
-                        }else {
-                            rgvNo = this.searchRgvNo(staNo);
-                        }
-                        if (rgvNo == null || rgvNo==0) {//鏈壘鍒板彲鐢ㄧ殑rgv
-                            continue;
-                        }
-                        wrkMast.setRgvNo(rgvNo);//缁戝畾rgv鍙�
-                        if (wrkMastMapper.updateById(wrkMast)==0){
-                            log.error("缁戝畾灏忚溅鏇存柊宸ヤ綔妗eけ璐ワ紒锛侊紒 [宸ヤ綔鍙凤細{}]", wrkMast.getWrkNo());
-                        }
-                    }
-                }
-                //鍑哄簱缁戝皬杞�
-                for (DevpSlave.Sta Sta : devp.getOutRgvSta()) {
-                    StaProtocol staProtocol = devpThread.getStation().get(Sta.getStaNo());
-                    if (staProtocol == null) {
-                        continue;
-                    } else {
-                        staProtocol = staProtocol.clone();
-                    }
-                    if (staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.getWorkNo() != 0 && staProtocol.getWorkNo() < 9990){
-                        List<WrkMast> wrkMasts = wrkMastMapper.selectList(new EntityWrapper<WrkMast>().eq("wrk_no", staProtocol.getWorkNo()).eq("wrk_sts", 14L));
-                        if (Cools.isEmpty(wrkMasts) || wrkMasts.size()!=1){
-                            continue;
-                        }
-                        WrkMast wrkMast = wrkMasts.get(0);
-                        //鐩爣绔�
-                        Integer staNo = wrkMast.getStaNo();
-                        //閫氳繃鐩爣绔欐悳绱gv鍙�
-                        Integer rgvNo=0;
-                        if (wrkMast.getCrnNo()==1){
-                            rgvNo=1;
-                        }else if (wrkMast.getCrnNo()==6){
-                            rgvNo=2;
-                        }else {
-                            rgvNo = this.searchRgvNo(staNo);
-                        }
-                        if (rgvNo == null || rgvNo==0) {//鏈壘鍒板彲鐢ㄧ殑rgv
-                            continue;
-                        }
-                        wrkMast.setRgvNo(rgvNo);//缁戝畾rgv鍙�
-                        if (wrkMastMapper.updateById(wrkMast)==0){
-                            log.error("缁戝畾灏忚溅鏇存柊宸ヤ綔妗eけ璐ワ紒锛侊紒 [宸ヤ綔鍙凤細{}]", wrkMast.getWrkNo());
-                        }
-                    }
-                }
-            }
-        }catch (Exception e){
-            log.error("缁戝畾灏忚溅寮傚父锛歿}", e.getMessage());
-        }
-    }
-
-    /**
-     * 缁戝畾灏忚溅鏂规硶
-     */
-    public synchronized void rgvBindSte2() {
-        try{
-            for (RgvSlave rgv : slaveProperties.getRgv()) {
-                List<WrkMast> wrkMasts = wrkMastMapper.selectWaitBindRGVRgvNo(rgv.getId());
-                if (!Cools.isEmpty(wrkMasts) && wrkMasts.size()!=0){
-                    continue;
-                }
-                List<WrkMast> wrkMasts2 = wrkMastMapper.selectWaitBindRgvNo2(rgv.getId());
-                for (WrkMast wrkMast : wrkMasts2) {
-                    if (wrkMastMapper.selectWaitBindRgvNoOneWrkNo(wrkMast.getWrkNo())!=null){
-                        continue;
-                    }
-                    //鐩爣绔�
-                    BasDevp basDevp = basDevpService.selectById(wrkMast.getRgvDstaNo());
-                    if (Cools.isEmpty(basDevp) || !basDevp.getAutoing().equals("Y") || !basDevp.getLoading().equals("N") || basDevp.getWrkNo()!=0){
-                        continue;
-                    }
-                    wrkMastMapper.insertRgvMast(wrkMast.getWrkNo());
-                    wrkMastMapper.updateRgvMast(wrkMast.getWrkNo());
-                    break;
-                }
-            }
-        }catch (Exception e){
-            log.error("灏忚溅鎼繍浠诲姟寮傚父锛歿}", e.getMessage());
-        }
-    }
-
-    /**
-     * 鍏ュ嚭搴�  ===>>  RGV鍏ュ嚭搴撲綔涓氫笅鍙�
-     */
-    public synchronized void rgvIoExecuteOld() {
-        for (RgvSlave rgv : slaveProperties.getRgv()) {
-            // 鑾峰彇RGV淇℃伅
-            RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgv.getId());
-            RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
-            if (rgvProtocol == null) {
-                continue;
-            }
-            BasRgv basRgv = basRgvService.selectById(rgv.getId());
-            if (basRgv == null) {
-                log.error("{}鍙稲GV灏氭湭鍦ㄦ暟鎹簱杩涜缁存姢锛�", rgv.getId());
-                continue;
-            }
-
-            // 鍙湁褰揜GV绌洪棽銆佽嚜鍔�,
-            if (rgvProtocol.getStatusType() == RgvStatusType.IDLE
-                    && rgvProtocol.getModeType() == RgvModeType.AUTO
-//                    && rgvProtocol.getTaskNo1() == 0 && rgvProtocol.getTaskNo2() == 0
-//                    && rgvProtocol.getLoaded1() == 0 && rgvProtocol.getLoaded2() == 0
-            ) {
-
-                //鏌ユ壘鏄惁瀛樺湪鍏ュ嚭搴撳伐浣滀腑绛夊緟RGV鎼繍鐨勪换鍔�
-                List<WrkMast> wrkMasts = wrkMastMapper.selectIoRgvNo(rgv.getId());
-                for (WrkMast wrkMast : wrkMasts) {
-                    if (wrkMast.getWrkSts() == 2) {//2.璁惧涓婅蛋1 => 3.RGV鍙栬揣涓�
-                        if (rgvProtocol.getTaskNo1() != 0 || rgvProtocol.getLoaded1() != 0) {//RGV鏄惁鏃犱换鍔°�丷GV鏄惁鏃犺揣
-                            continue;
-                        }
-
-                        //鍒ゆ柇琛岃蛋璺緞鏄惁琚崰鐢�
-                        Integer staNo = wrkMast.getSourceStaNo();
-                        BasDevp basDevp = basDevpService.selectById(staNo);
-                        if (basDevp == null) {
-                            continue;//鐩爣绔欎笉瀛樺湪
-                        }
-                        //璧峰璺緞
-                        int startPath = rgvProtocol.getRgvPos().intValue();
-                        //鐩爣璺緞鍊�
-                        int endPath = basDevp.getLocType3().intValue();
-//                        boolean pathUsed = RgvUtils.isPathUsed(startPath, endPath);//鍒ゆ柇琛岃蛋璺緞鏄惁琚崰鐢�
-                        boolean pathUsed = RgvUtils.isPathUsed(startPath, endPath);//鍒ゆ柇琛岃蛋璺緞鏄惁琚崰鐢�
-                        if (pathUsed) {
-                            //琛岃蛋璺緞琚崰鐢紝绂佹涓嬪彂鍛戒护
-                            continue;
-                        }
-                        //琛岃蛋璺緞绌洪棽锛岄攣瀹氳矾寰�
-                        RgvUtils.lockPath(startPath, endPath, rgvProtocol.getRgvNo(), wrkMast.getWrkNo(), true);
-
-                        //  鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
-                        RgvCommand rgvCommand = new RgvCommand();
-                        rgvCommand.setRgvNo(wrkMast.getRgvNo()); // RGV缂栧彿
-                        rgvCommand.setAckFinish1((short) 0);  // 宸ヤ綅1浠诲姟瀹屾垚纭浣�
-                        rgvCommand.setTaskNo1(wrkMast.getWrkNo().shortValue()); // 宸ヤ綅1宸ヤ綔鍙�
-                        rgvCommand.setTaskMode1(RgvTaskModeType.FETCH); // 宸ヤ綅1浠诲姟妯″紡:  鍙栬揣
-                        rgvCommand.setDestinationStaNo1(wrkMast.getRgvDstaNo().shortValue());   //宸ヤ綅1鐩爣绔欑偣
-                        rgvCommand.setCommand((short) 1);   //宸ヤ綅1浠诲姟纭
-                        if (!MessageQueue.offer(SlaveType.Crn, wrkMast.getRgvNo(), new Task(4, rgvCommand))) {
-                            //step=2,宸ヤ綅1銆�2鍐欎换鍔★紱   step=4锛屽伐浣�1鍐欎换鍔★紱     step=5锛屽伐浣�2鍐欎换鍔�
-                            log.error("RGV鍛戒护涓嬪彂澶辫触锛孯GV鍙�={}锛屼换鍔℃暟鎹�={}", wrkMast.getRgvNo(), JSON.toJSON(rgvCommand));
-                        } else {
-                            // 淇敼宸ヤ綔妗g姸鎬� 2.璁惧涓婅蛋1 => 3.RGV鍙栬揣涓�
-                            Date now = new Date();
-                            wrkMast.setWrkSts(3L);
-                            wrkMast.setModiTime(now);
-                            if (wrkMastMapper.updateById(wrkMast) == 0) {
-                                log.error("淇敼宸ヤ綔妗g姸鎬� 2.璁惧涓婅蛋1 => 3.RGV鍙栬揣涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
-                            }
-                        }
-                    } else if (wrkMast.getWrkSts() == 14) {//4.RGV鍙栬揣瀹屾垚 => 5.RGV鏀捐揣涓�   14鍑哄簱瀹屾垚
-                        if (rgvProtocol.getTaskNo1() == 0 || !rgvProtocol.getTaskNo1().equals(wrkMast.getWrkNo().shortValue())) {//RGV蹇呴』鏈変换鍔′笖浠诲姟鍜屽綋鍓嶅伐浣滄。涓�鑷�
-                            continue;
-                        }
-                        if (rgvProtocol.getLoaded1() == 0) {//RGV蹇呴』鏈夌墿
-                            continue;
-                        }
-
-                        //鍒ゆ柇琛岃蛋璺緞鏄惁琚崰鐢�
-                        Integer staNo = wrkMast.getStaNo();
-                        BasDevp basDevp = basDevpService.selectById(staNo);
-                        if (basDevp == null) {
-                            continue;//鐩爣绔欎笉瀛樺湪
-                        }
-                        //璧峰璺緞
-                        int startPath = rgvProtocol.getRgvPos().intValue();
-                        //鐩爣璺緞鍊�
-                        int endPath = basDevp.getLocType3().intValue();
-                        boolean pathUsed = RgvUtils.isPathUsed(startPath, endPath);//鍒ゆ柇琛岃蛋璺緞鏄惁琚崰鐢�
-                        if (pathUsed) {
-                            //琛岃蛋璺緞琚崰鐢紝绂佹涓嬪彂鍛戒护
-                            continue;
-                        }
-                        //琛岃蛋璺緞绌洪棽锛岄攣瀹氳矾寰�
-                        RgvUtils.lockPath(startPath, endPath, rgvProtocol.getRgvNo(), wrkMast.getWrkNo(), true);
-
-                        //  鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
-                        RgvCommand rgvCommand = new RgvCommand();
-                        rgvCommand.setRgvNo(wrkMast.getRgvNo()); // RGV缂栧彿
-                        rgvCommand.setAckFinish1((short) 0);  // 宸ヤ綅1浠诲姟瀹屾垚纭浣�
-                        rgvCommand.setTaskNo1(wrkMast.getWrkNo().shortValue()); // 宸ヤ綅1宸ヤ綔鍙�
-                        rgvCommand.setTaskMode1(RgvTaskModeType.PUT); // 宸ヤ綅1浠诲姟妯″紡:  鏀捐揣
-                        rgvCommand.setDestinationStaNo1(wrkMast.getRgvDstaNo().shortValue());   //宸ヤ綅1鐩爣绔欑偣
-                        rgvCommand.setCommand((short) 1);   //宸ヤ綅1浠诲姟纭
-                        if (!MessageQueue.offer(SlaveType.Crn, wrkMast.getRgvNo(), new Task(4, rgvCommand))) {
-                            //step=2,宸ヤ綅1銆�2鍐欎换鍔★紱   step=4锛屽伐浣�1鍐欎换鍔★紱     step=5锛屽伐浣�2鍐欎换鍔�
-                            log.error("RGV鍛戒护涓嬪彂澶辫触锛孯GV鍙�={}锛屼换鍔℃暟鎹�={}", wrkMast.getRgvNo(), JSON.toJSON(rgvCommand));
-                        } else {
-                            // 淇敼宸ヤ綔妗g姸鎬� 4.RGV鍙栬揣瀹屾垚 => 5.RGV鏀捐揣涓�
-                            Date now = new Date();
-                            wrkMast.setWrkSts(5L);
-                            wrkMast.setModiTime(now);
-                            if (wrkMastMapper.updateById(wrkMast) == 0) {
-                                log.error("淇敼宸ヤ綔妗g姸鎬� 4.RGV鍙栬揣瀹屾垚 => 5.RGV鏀捐揣涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
-                            }
-                        }
-                    } else if (wrkMast.getWrkSts() == 23) {//23.璁惧涓婅蛋1 => 24.RGV鍙栬揣涓�
-                        if (rgvProtocol.getTaskNo1() != 0 || rgvProtocol.getLoaded1() != 0) {//RGV鏄惁鏃犱换鍔°�丷GV鏄惁鏃犺揣
-                            continue;
-                        }
-
-                        //鍒ゆ柇琛岃蛋璺緞鏄惁琚崰鐢�
-                        Integer staNo = wrkMast.getSourceStaNo();
-                        BasDevp basDevp = basDevpService.selectById(staNo);
-                        if (basDevp == null) {
-                            continue;//鐩爣绔欎笉瀛樺湪
-                        }
-                        //璧峰璺緞
-                        int startPath = rgvProtocol.getRgvPos().intValue();
-                        //鐩爣璺緞鍊�
-                        int endPath = basDevp.getLocType3().intValue();
-                        boolean pathUsed = RgvUtils.isPathUsed(startPath, endPath);//鍒ゆ柇琛岃蛋璺緞鏄惁琚崰鐢�
-                        if (pathUsed) {
-                            //琛岃蛋璺緞琚崰鐢紝绂佹涓嬪彂鍛戒护
-                            continue;
-                        }
-                        //琛岃蛋璺緞绌洪棽锛岄攣瀹氳矾寰�
-                        RgvUtils.lockPath(startPath, endPath, rgvProtocol.getRgvNo(), wrkMast.getWrkNo(), true);
-
-                        //  鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
-                        RgvCommand rgvCommand = new RgvCommand();
-                        rgvCommand.setRgvNo(wrkMast.getRgvNo()); // RGV缂栧彿
-                        rgvCommand.setAckFinish1((short) 0);  // 宸ヤ綅1浠诲姟瀹屾垚纭浣�
-                        rgvCommand.setTaskNo1(wrkMast.getWrkNo().shortValue()); // 宸ヤ綅1宸ヤ綔鍙�
-                        rgvCommand.setTaskMode1(RgvTaskModeType.FETCH); // 宸ヤ綅1浠诲姟妯″紡:  鍙栬揣
-                        rgvCommand.setDestinationStaNo1(wrkMast.getRgvDstaNo().shortValue());   //宸ヤ綅1鐩爣绔欑偣
-                        rgvCommand.setCommand((short) 1);   //宸ヤ綅1浠诲姟纭
-                        if (!MessageQueue.offer(SlaveType.Crn, wrkMast.getRgvNo(), new Task(4, rgvCommand))) {
-                            //step=2,宸ヤ綅1銆�2鍐欎换鍔★紱   step=4锛屽伐浣�1鍐欎换鍔★紱     step=5锛屽伐浣�2鍐欎换鍔�
-                            log.error("RGV鍛戒护涓嬪彂澶辫触锛孯GV鍙�={}锛屼换鍔℃暟鎹�={}", wrkMast.getRgvNo(), JSON.toJSON(rgvCommand));
-                        } else {
-                            // 淇敼宸ヤ綔妗g姸鎬� 23.璁惧涓婅蛋1 => 24.RGV鍙栬揣涓�
-                            Date now = new Date();
-                            wrkMast.setWrkSts(24L);
-                            wrkMast.setModiTime(now);
-                            if (wrkMastMapper.updateById(wrkMast) == 0) {
-                                log.error("淇敼宸ヤ綔妗g姸鎬� 23.璁惧涓婅蛋1 => 24.RGV鍙栬揣涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
-                            }
-                        }
-                    } else if (wrkMast.getWrkSts() == 25) {//25.RGV鍙栬揣瀹屾垚 => 26.RGV鏀捐揣涓�
-                        if (rgvProtocol.getTaskNo1() == 0 || !rgvProtocol.getTaskNo1().equals(wrkMast.getWrkNo().shortValue())) {//RGV蹇呴』鏈変换鍔′笖浠诲姟鍜屽綋鍓嶅伐浣滄。涓�鑷�
-                            continue;
-                        }
-                        if (rgvProtocol.getLoaded1() == 0) {//RGV蹇呴』鏈夌墿
-                            continue;
-                        }
-
-                        //鍒ゆ柇琛岃蛋璺緞鏄惁琚崰鐢�
-                        Integer staNo = wrkMast.getStaNo();
-                        BasDevp basDevp = basDevpService.selectById(staNo);
-                        if (basDevp == null) {
-                            continue;//鐩爣绔欎笉瀛樺湪
-                        }
-                        //璧峰璺緞
-                        int startPath = rgvProtocol.getRgvPos().intValue();
-                        //鐩爣璺緞鍊�
-                        int endPath = basDevp.getLocType3().intValue();
-                        boolean pathUsed = RgvUtils.isPathUsed(startPath, endPath);//鍒ゆ柇琛岃蛋璺緞鏄惁琚崰鐢�
-                        if (pathUsed) {
-                            //琛岃蛋璺緞琚崰鐢紝绂佹涓嬪彂鍛戒护
-                            continue;
-                        }
-                        //琛岃蛋璺緞绌洪棽锛岄攣瀹氳矾寰�
-                        RgvUtils.lockPath(startPath, endPath, rgvProtocol.getRgvNo(), wrkMast.getWrkNo(), true);
-
-                        //  鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
-                        RgvCommand rgvCommand = new RgvCommand();
-                        rgvCommand.setRgvNo(wrkMast.getRgvNo()); // RGV缂栧彿
-                        rgvCommand.setAckFinish1((short) 0);  // 宸ヤ綅1浠诲姟瀹屾垚纭浣�
-                        rgvCommand.setTaskNo1(wrkMast.getWrkNo().shortValue()); // 宸ヤ綅1宸ヤ綔鍙�
-                        rgvCommand.setTaskMode1(RgvTaskModeType.PUT); // 宸ヤ綅1浠诲姟妯″紡:  鏀捐揣
-                        rgvCommand.setDestinationStaNo1(wrkMast.getRgvDstaNo().shortValue());   //宸ヤ綅1鐩爣绔欑偣
-                        rgvCommand.setCommand((short) 1);   //宸ヤ綅1浠诲姟纭
-                        if (!MessageQueue.offer(SlaveType.Crn, wrkMast.getRgvNo(), new Task(4, rgvCommand))) {
-                            //step=2,宸ヤ綅1銆�2鍐欎换鍔★紱   step=4锛屽伐浣�1鍐欎换鍔★紱     step=5锛屽伐浣�2鍐欎换鍔�
-                            log.error("RGV鍛戒护涓嬪彂澶辫触锛孯GV鍙�={}锛屼换鍔℃暟鎹�={}", wrkMast.getRgvNo(), JSON.toJSON(rgvCommand));
-                        } else {
-                            // 淇敼宸ヤ綔妗g姸鎬� 25.RGV鍙栬揣瀹屾垚 => 26.RGV鏀捐揣涓�
-                            Date now = new Date();
-                            wrkMast.setWrkSts(26L);
-                            wrkMast.setModiTime(now);
-                            if (wrkMastMapper.updateById(wrkMast) == 0) {
-                                log.error("淇敼宸ヤ綔妗g姸鎬� 25.RGV鍙栬揣瀹屾垚 => 26.RGV鏀捐揣涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
-                            }
-                        }
-                    }
-                }
-
-            }
-        }
-    }
-
-    /**
-     * 鍏ュ嚭搴�  ===>>  RGV鍏ュ嚭搴撲綔涓氫笅鍙�
-     */
-    public synchronized void rgvIoExecute() {
-        for (RgvSlave rgv : slaveProperties.getRgv()) {
-            RgvSlave rgvSlave=null;
-            if (rgv.getId()==1){
-                rgvSlave = slaveProperties.getRgv().get(1);
-            }else {
-                rgvSlave = slaveProperties.getRgv().get(0);
-            }
-
-            // 鑾峰彇RGV淇℃伅
-            RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgv.getId());
-            RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
-            if (rgvProtocol == null) {
-                continue;
-            }
-
-            RgvThread rgvThreadSlave = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgvSlave.getId());
-            RgvProtocol rgvProtocolSlave = rgvThreadSlave.getRgvProtocol();
-            BasRgv basRgvSlave = null;
-            if (rgvProtocolSlave == null) {
-                rgvSlave=null;
-            }else {
-                basRgvSlave = basRgvService.selectById(rgv.getId());
-                if (basRgvSlave == null) {
-                    rgvSlave=null;
-                }
-            }
-
-            BasRgv basRgv = basRgvService.selectById(rgv.getId());
-            if (basRgv == null) {
-                log.error("{}鍙稲GV灏氭湭鍦ㄦ暟鎹簱杩涜缁存姢锛�", rgv.getId());
-                continue;
-            }
-
-            boolean signSlave=false;//姝ゅ鍒ゆ柇RgvSlave鏄惁宸茬粡瑙勯伩
-            boolean signSlaveState=false;//姝ゅ鍒ゆ柇RgvSlave鏄惁绌洪棽
-            Integer staSlave = 0;//姝ゅ璁板綍RgvSlave褰撳墠浣嶇疆
-
-            // 鍙湁褰揜GV绌洪棽銆佽嚜鍔�,
-            if (rgvProtocol.getStatusType() == RgvStatusType.IDLE
-                    && rgvProtocol.getModeType() == RgvModeType.AUTO
-//                    && rgvProtocol.getTaskNo1() == 0 && rgvProtocol.getTaskNo2() == 0
-//                    && rgvProtocol.getLoaded1() == 0 && rgvProtocol.getLoaded2() == 0
-                    ) {
-
-                //鏌ユ壘鏄惁瀛樺湪鍏ュ嚭搴撳伐浣滀腑绛夊緟RGV鎼繍鐨勪换鍔�
-                List<WrkMast> wrkMasts = wrkMastMapper.selectIoRgvNo(rgv.getId());
-                for (WrkMast wrkMast : wrkMasts) {
-                    if (wrkMast.getWrkSts() == 2) {//2.璁惧涓婅蛋1 => 3.RGV鍙栬揣涓�
-                        if (rgvProtocol.getTaskNo1() != 0 || rgvProtocol.getLoaded1() != 0) {//RGV鏄惁鏃犱换鍔°�丷GV鏄惁鏃犺揣
-                            continue;
-                        }
-
-                        //鍒ゆ柇琛岃蛋璺緞鏄惁琚崰鐢�
-                        Integer staNo = wrkMast.getSourceStaNo();
-                        BasDevp basDevp = basDevpService.selectById(staNo);
-                        if (basDevp == null) {
-                            continue;//鐩爣绔欎笉瀛樺湪
-                        }
-                        //璧峰璺緞
-                        int startPath = rgvProtocol.getRgvPos().intValue();
-                        //鐩爣璺緞鍊�
-                        int endPath = basDevp.getLocType3().intValue();
-//                        boolean pathUsed = RgvUtils.isPathUsed(startPath, endPath);//鍒ゆ柇琛岃蛋璺緞鏄惁琚崰鐢�
-                        boolean pathUsed = RgvUtils.isPathUsed(startPath, endPath);//鍒ゆ柇琛岃蛋璺緞鏄惁琚崰鐢�
-                        if (pathUsed) {
-                            //琛岃蛋璺緞琚崰鐢紝绂佹涓嬪彂鍛戒护
-                            continue;
-                        }
-                        //琛岃蛋璺緞绌洪棽锛岄攣瀹氳矾寰�
-                        RgvUtils.lockPath(startPath, endPath, rgvProtocol.getRgvNo(), wrkMast.getWrkNo(), true);
-
-                        //  鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
-                        RgvCommand rgvCommand = new RgvCommand();
-                        rgvCommand.setRgvNo(wrkMast.getRgvNo()); // RGV缂栧彿
-                        rgvCommand.setAckFinish1((short) 0);  // 宸ヤ綅1浠诲姟瀹屾垚纭浣�
-                        rgvCommand.setTaskNo1(wrkMast.getWrkNo().shortValue()); // 宸ヤ綅1宸ヤ綔鍙�
-                        rgvCommand.setTaskMode1(RgvTaskModeType.FETCH); // 宸ヤ綅1浠诲姟妯″紡:  鍙栬揣
-                        rgvCommand.setDestinationStaNo1(wrkMast.getRgvDstaNo().shortValue());   //宸ヤ綅1鐩爣绔欑偣
-                        rgvCommand.setCommand((short) 1);   //宸ヤ綅1浠诲姟纭
-                        if (!MessageQueue.offer(SlaveType.Crn, wrkMast.getRgvNo(), new Task(4, rgvCommand))) {
-                            //step=2,宸ヤ綅1銆�2鍐欎换鍔★紱   step=4锛屽伐浣�1鍐欎换鍔★紱     step=5锛屽伐浣�2鍐欎换鍔�
-                            log.error("RGV鍛戒护涓嬪彂澶辫触锛孯GV鍙�={}锛屼换鍔℃暟鎹�={}", wrkMast.getRgvNo(), JSON.toJSON(rgvCommand));
-                        } else {
-                            // 淇敼宸ヤ綔妗g姸鎬� 2.璁惧涓婅蛋1 => 3.RGV鍙栬揣涓�
-                            Date now = new Date();
-                            wrkMast.setWrkSts(3L);
-                            wrkMast.setModiTime(now);
-                            if (wrkMastMapper.updateById(wrkMast) == 0) {
-                                log.error("淇敼宸ヤ綔妗g姸鎬� 2.璁惧涓婅蛋1 => 3.RGV鍙栬揣涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
-                            }
-                        }
-                    } else if (wrkMast.getWrkSts() == 14) {//4.RGV鍙栬揣瀹屾垚 => 5.RGV鏀捐揣涓�   14鍑哄簱瀹屾垚
-                        if (rgvProtocol.getTaskNo1() == 0 || !rgvProtocol.getTaskNo1().equals(wrkMast.getWrkNo().shortValue())) {//RGV蹇呴』鏈変换鍔′笖浠诲姟鍜屽綋鍓嶅伐浣滄。涓�鑷�
-                            continue;
-                        }
-                        if (rgvProtocol.getLoaded1() == 0) {//RGV蹇呴』鏈夌墿
-                            continue;
-                        }
-
-                        //鍒ゆ柇琛岃蛋璺緞鏄惁琚崰鐢�
-                        Integer staNo = wrkMast.getStaNo();
-                        BasDevp basDevp = basDevpService.selectById(staNo);
-                        if (basDevp == null) {
-                            continue;//鐩爣绔欎笉瀛樺湪
-                        }
-                        //璧峰璺緞
-                        int startPath = rgvProtocol.getRgvPos().intValue();
-                        //鐩爣璺緞鍊�
-                        int endPath = basDevp.getLocType3().intValue();
-                        boolean pathUsed = RgvUtils.isPathUsed(startPath, endPath);//鍒ゆ柇琛岃蛋璺緞鏄惁琚崰鐢�
-                        if (pathUsed) {
-                            //琛岃蛋璺緞琚崰鐢紝绂佹涓嬪彂鍛戒护
-                            continue;
-                        }
-                        //琛岃蛋璺緞绌洪棽锛岄攣瀹氳矾寰�
-                        RgvUtils.lockPath(startPath, endPath, rgvProtocol.getRgvNo(), wrkMast.getWrkNo(), true);
-
-                        //  鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
-                        RgvCommand rgvCommand = new RgvCommand();
-                        rgvCommand.setRgvNo(wrkMast.getRgvNo()); // RGV缂栧彿
-                        rgvCommand.setAckFinish1((short) 0);  // 宸ヤ綅1浠诲姟瀹屾垚纭浣�
-                        rgvCommand.setTaskNo1(wrkMast.getWrkNo().shortValue()); // 宸ヤ綅1宸ヤ綔鍙�
-                        rgvCommand.setTaskMode1(RgvTaskModeType.PUT); // 宸ヤ綅1浠诲姟妯″紡:  鏀捐揣
-                        rgvCommand.setDestinationStaNo1(wrkMast.getRgvDstaNo().shortValue());   //宸ヤ綅1鐩爣绔欑偣
-                        rgvCommand.setCommand((short) 1);   //宸ヤ綅1浠诲姟纭
-                        if (!MessageQueue.offer(SlaveType.Crn, wrkMast.getRgvNo(), new Task(4, rgvCommand))) {
-                            //step=2,宸ヤ綅1銆�2鍐欎换鍔★紱   step=4锛屽伐浣�1鍐欎换鍔★紱     step=5锛屽伐浣�2鍐欎换鍔�
-                            log.error("RGV鍛戒护涓嬪彂澶辫触锛孯GV鍙�={}锛屼换鍔℃暟鎹�={}", wrkMast.getRgvNo(), JSON.toJSON(rgvCommand));
-                        } else {
-                            // 淇敼宸ヤ綔妗g姸鎬� 4.RGV鍙栬揣瀹屾垚 => 5.RGV鏀捐揣涓�
-                            Date now = new Date();
-                            wrkMast.setWrkSts(5L);
-                            wrkMast.setModiTime(now);
-                            if (wrkMastMapper.updateById(wrkMast) == 0) {
-                                log.error("淇敼宸ヤ綔妗g姸鎬� 4.RGV鍙栬揣瀹屾垚 => 5.RGV鏀捐揣涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
-                            }
-                        }
-                    } else if (wrkMast.getWrkSts() == 23) {//23.璁惧涓婅蛋1 => 24.RGV鍙栬揣涓�
-                        if (rgvProtocol.getTaskNo1() != 0 || rgvProtocol.getLoaded1() != 0) {//RGV鏄惁鏃犱换鍔°�丷GV鏄惁鏃犺揣
-                            continue;
-                        }
-
-                        //鍒ゆ柇琛岃蛋璺緞鏄惁琚崰鐢�
-                        Integer staNo = wrkMast.getSourceStaNo();
-                        BasDevp basDevp = basDevpService.selectById(staNo);
-                        if (basDevp == null) {
-                            continue;//鐩爣绔欎笉瀛樺湪
-                        }
-                        //璧峰璺緞
-                        int startPath = rgvProtocol.getRgvPos().intValue();
-                        //鐩爣璺緞鍊�
-                        int endPath = basDevp.getLocType3().intValue();
-                        boolean pathUsed = RgvUtils.isPathUsed(startPath, endPath);//鍒ゆ柇琛岃蛋璺緞鏄惁琚崰鐢�
-                        if (pathUsed) {
-                            //琛岃蛋璺緞琚崰鐢紝绂佹涓嬪彂鍛戒护
-                            continue;
-                        }
-                        //琛岃蛋璺緞绌洪棽锛岄攣瀹氳矾寰�
-                        RgvUtils.lockPath(startPath, endPath, rgvProtocol.getRgvNo(), wrkMast.getWrkNo(), true);
-
-                        //  鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
-                        RgvCommand rgvCommand = new RgvCommand();
-                        rgvCommand.setRgvNo(wrkMast.getRgvNo()); // RGV缂栧彿
-                        rgvCommand.setAckFinish1((short) 0);  // 宸ヤ綅1浠诲姟瀹屾垚纭浣�
-                        rgvCommand.setTaskNo1(wrkMast.getWrkNo().shortValue()); // 宸ヤ綅1宸ヤ綔鍙�
-                        rgvCommand.setTaskMode1(RgvTaskModeType.FETCH); // 宸ヤ綅1浠诲姟妯″紡:  鍙栬揣
-                        rgvCommand.setDestinationStaNo1(wrkMast.getRgvDstaNo().shortValue());   //宸ヤ綅1鐩爣绔欑偣
-                        rgvCommand.setCommand((short) 1);   //宸ヤ綅1浠诲姟纭
-                        if (!MessageQueue.offer(SlaveType.Crn, wrkMast.getRgvNo(), new Task(4, rgvCommand))) {
-                            //step=2,宸ヤ綅1銆�2鍐欎换鍔★紱   step=4锛屽伐浣�1鍐欎换鍔★紱     step=5锛屽伐浣�2鍐欎换鍔�
-                            log.error("RGV鍛戒护涓嬪彂澶辫触锛孯GV鍙�={}锛屼换鍔℃暟鎹�={}", wrkMast.getRgvNo(), JSON.toJSON(rgvCommand));
-                        } else {
-                            // 淇敼宸ヤ綔妗g姸鎬� 23.璁惧涓婅蛋1 => 24.RGV鍙栬揣涓�
-                            Date now = new Date();
-                            wrkMast.setWrkSts(24L);
-                            wrkMast.setModiTime(now);
-                            if (wrkMastMapper.updateById(wrkMast) == 0) {
-                                log.error("淇敼宸ヤ綔妗g姸鎬� 23.璁惧涓婅蛋1 => 24.RGV鍙栬揣涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
-                            }
-                        }
-                    } else if (wrkMast.getWrkSts() == 25) {//25.RGV鍙栬揣瀹屾垚 => 26.RGV鏀捐揣涓�
-                        if (rgvProtocol.getTaskNo1() == 0 || !rgvProtocol.getTaskNo1().equals(wrkMast.getWrkNo().shortValue())) {//RGV蹇呴』鏈変换鍔′笖浠诲姟鍜屽綋鍓嶅伐浣滄。涓�鑷�
-                            continue;
-                        }
-                        if (rgvProtocol.getLoaded1() == 0) {//RGV蹇呴』鏈夌墿
-                            continue;
-                        }
-
-                        //鍒ゆ柇琛岃蛋璺緞鏄惁琚崰鐢�
-                        Integer staNo = wrkMast.getStaNo();
-                        BasDevp basDevp = basDevpService.selectById(staNo);
-                        if (basDevp == null) {
-                            continue;//鐩爣绔欎笉瀛樺湪
-                        }
-                        //璧峰璺緞
-                        int startPath = rgvProtocol.getRgvPos().intValue();
-                        //鐩爣璺緞鍊�
-                        int endPath = basDevp.getLocType3().intValue();
-                        boolean pathUsed = RgvUtils.isPathUsed(startPath, endPath);//鍒ゆ柇琛岃蛋璺緞鏄惁琚崰鐢�
-                        if (pathUsed) {
-                            //琛岃蛋璺緞琚崰鐢紝绂佹涓嬪彂鍛戒护
-                            continue;
-                        }
-                        //琛岃蛋璺緞绌洪棽锛岄攣瀹氳矾寰�
-                        RgvUtils.lockPath(startPath, endPath, rgvProtocol.getRgvNo(), wrkMast.getWrkNo(), true);
-
-                        //  鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
-                        RgvCommand rgvCommand = new RgvCommand();
-                        rgvCommand.setRgvNo(wrkMast.getRgvNo()); // RGV缂栧彿
-                        rgvCommand.setAckFinish1((short) 0);  // 宸ヤ綅1浠诲姟瀹屾垚纭浣�
-                        rgvCommand.setTaskNo1(wrkMast.getWrkNo().shortValue()); // 宸ヤ綅1宸ヤ綔鍙�
-                        rgvCommand.setTaskMode1(RgvTaskModeType.PUT); // 宸ヤ綅1浠诲姟妯″紡:  鏀捐揣
-                        rgvCommand.setDestinationStaNo1(wrkMast.getRgvDstaNo().shortValue());   //宸ヤ綅1鐩爣绔欑偣
-                        rgvCommand.setCommand((short) 1);   //宸ヤ綅1浠诲姟纭
-                        if (!MessageQueue.offer(SlaveType.Crn, wrkMast.getRgvNo(), new Task(4, rgvCommand))) {
-                            //step=2,宸ヤ綅1銆�2鍐欎换鍔★紱   step=4锛屽伐浣�1鍐欎换鍔★紱     step=5锛屽伐浣�2鍐欎换鍔�
-                            log.error("RGV鍛戒护涓嬪彂澶辫触锛孯GV鍙�={}锛屼换鍔℃暟鎹�={}", wrkMast.getRgvNo(), JSON.toJSON(rgvCommand));
-                        } else {
-                            // 淇敼宸ヤ綔妗g姸鎬� 25.RGV鍙栬揣瀹屾垚 => 26.RGV鏀捐揣涓�
-                            Date now = new Date();
-                            wrkMast.setWrkSts(26L);
-                            wrkMast.setModiTime(now);
-                            if (wrkMastMapper.updateById(wrkMast) == 0) {
-                                log.error("淇敼宸ヤ綔妗g姸鎬� 25.RGV鍙栬揣瀹屾垚 => 26.RGV鏀捐揣涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
-                            }
-                        }
-                    }
-                }
-
-            }
-        }
-    }
-
-    private boolean rgvIoExecuteWrk2To3() {
-        return false;
     }
 
     /**
@@ -1617,28 +1322,28 @@
                 continue;
             }
 
-            boolean flag = false;
+            boolean flag = true;
             // 鑾峰彇鍫嗗灈鏈哄叆搴撶珯淇℃伅
-            DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, crnStn.getDevpPlcId());
-            StaProtocol staProtocol = devpThread.getStation().get(crnStn.getStaNo());
-            if (staProtocol == null) {
-                continue;
-            } else {
-                staProtocol = staProtocol.clone();
-            }
-            // 鏌ヨ绔欑偣璇︾粏淇℃伅
-            BasDevp staDetl = basDevpService.selectById(crnStn.getStaNo());
-            if (staDetl == null) {
-                log.error("鍏ュ簱 ===>> 鍫嗗灈鏈虹珯鐐瑰湪鏁版嵁搴撲笉瀛樺湪, 绔欑偣缂栧彿={}", crnStn.getStaNo());
-                continue;
-            }
-            if (staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.getWorkNo() > 0 && staProtocol.isInEnable()
-                    && staDetl.getCanining() != null && staDetl.getCanining().equals("Y")) {
-                flag = true;
-            }
-            if (!flag) {
-                continue;
-            }
+//            DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, crnStn.getDevpPlcId());
+//            StaProtocol staProtocol = devpThread.getStation().get(crnStn.getStaNo());
+//            if (staProtocol == null) {
+//                continue;
+//            } else {
+//                staProtocol = staProtocol.clone();
+//            }
+//            // 鏌ヨ绔欑偣璇︾粏淇℃伅
+//            BasDevp staDetl = basDevpService.selectById(crnStn.getStaNo());
+//            if (staDetl == null) {
+//                log.error("鍏ュ簱 ===>> 鍫嗗灈鏈虹珯鐐瑰湪鏁版嵁搴撲笉瀛樺湪, 绔欑偣缂栧彿={}", crnStn.getStaNo());
+//                continue;
+//            }
+//            if (staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.getWorkNo() > 0 && staProtocol.isInEnable()
+//                    && staDetl.getCanining() != null && staDetl.getCanining().equals("Y")) {
+//                flag = true;
+//            }
+//            if (!flag) {
+//                continue;
+//            }
 
             // 鑾峰彇搴撲綅淇℃伅
             LocMast locMast = locMastService.selectById(wrkMast.getLocNo());
@@ -1699,18 +1404,19 @@
                 }
             }
 
-            // 鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
+            // 鍏ュ簱鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
             CrnCommand crnCommand = new CrnCommand();
             crnCommand.setCrnNo(slave.getId()); // 鍫嗗灈鏈虹紪鍙�
             crnCommand.setTaskNo(wrkMast.getWrkNo().shortValue()); // 宸ヤ綔鍙�
             crnCommand.setAckFinish((short) 0);  // 浠诲姟瀹屾垚纭浣�
             crnCommand.setTaskMode(CrnTaskModeType.LOC_MOVE); // 浠诲姟妯″紡:  搴撲綅绉昏浆
-            crnCommand.setSourcePosX(crnStn.getRow().shortValue());     // 婧愬簱浣嶆帓
-            crnCommand.setSourcePosY(crnStn.getBay().shortValue());     // 婧愬簱浣嶅垪
-            crnCommand.setSourcePosZ(crnStn.getLev().shortValue());     // 婧愬簱浣嶅眰
+            //crnCommand.setSourcePosX(crnStn.getRow().shortValue());     // 婧愬簱浣嶆帓
+            //crnCommand.setSourcePosY(crnStn.getBay().shortValue());     // 婧愬簱浣嶅垪
+            //crnCommand.setSourcePosZ(crnStn.getLev().shortValue());     // 婧愬簱浣嶅眰
             crnCommand.setDestinationPosX(locMast.getRow1().shortValue());     // 鐩爣搴撲綅鎺�
             crnCommand.setDestinationPosY(locMast.getBay1().shortValue());     // 鐩爣搴撲綅鍒�
             crnCommand.setDestinationPosZ(locMast.getLev1().shortValue());     // 鐩爣搴撲綅灞�
+            crnCommand.setSourceStaNo(crnStn.getPlatNo().shortValue());     // 婧愬簱浣嶆帓
             if (!MessageQueue.offer(SlaveType.Crn, wrkMast.getCrnNo(), new Task(2, crnCommand))) {
                 log.error("鍫嗗灈鏈哄懡浠や笅鍙戝け璐ワ紝鍫嗗灈鏈哄彿={}锛屼换鍔℃暟鎹�={}", wrkMast.getCrnNo(), JSON.toJSON(crnCommand));
             } else {
@@ -1871,7 +1577,17 @@
      */
     public synchronized void locToCrnStn1(CrnSlave slave, CrnProtocol crnProtocol) {
         List<WrkMast> wrkMasts = wrkMastMapper.selectPakOutStep12(slave.getId());
+        Integer count = wrkMastMapper.countPakOut();
+
         for (WrkMast wrkMast : wrkMasts) {
+            if(count > 30){ //璁惧涓婅蛋鎵樼洏涓嶈秴杩�30涓�
+                continue;
+            }
+            // 鍒ゆ柇鍫嗗灈鏈虹珯鐐规槸鍚﹀彲鐢�
+            if (!crnEnabled(wrkMast)){
+                continue;
+            }
+
             if (wrkMast == null) {
                 continue;
             }
@@ -1887,8 +1603,10 @@
                 continue;
             }
 
+            log.info("{}鍙峰爢鍨涙満閫夊畾鐨勫嚭搴撳彛鏄瘂}",crnProtocol.getCrnNo(),crnStn.getPlatNo());
+
             // 宸ヤ綔妗g姸鎬佸垽鏂�
-            if (wrkMast.getIoType() < 100 || wrkMast.getSourceStaNo() == null) {
+            if ((wrkMast.getIoType() < 100 && wrkMast.getIoType()!=12) || wrkMast.getSourceStaNo() == null) {
                 log.error("鏌ヨ宸ヤ綔妗f暟鎹笉绗﹀悎鏉′欢--鍏ュ嚭绫诲瀷/绔欑偣, 宸ヤ綔鍙�={}锛屾簮搴撲綅={}锛屽叆鍑虹被鍨�={}", wrkMast.getWrkNo(), wrkMast.getSourceLocNo(), wrkMast.getIoType());
                 continue;
             }
@@ -1899,20 +1617,20 @@
                 continue;
             }
             // 鑾峰彇鍫嗗灈鏈哄嚭搴撶珯淇℃伅
-            SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, crnStn.getDevpPlcId());
-            StaProtocol staProtocol = devpThread.getStation().get(crnStn.getStaNo());
-            if (staProtocol == null) {
-                break;
-//                    continue;
-            } else {
-                staProtocol = staProtocol.clone();
-            }
+            //SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, crnStn.getDevpPlcId());
+            //StaProtocol staProtocol = devpThread.getStation().get(crnStn.getStaNo());
+//            if (staProtocol == null) {
+//                break;
+////                    continue;
+//            } else {
+//                staProtocol = staProtocol.clone();
+//            }
 
 //            // 鍏ュ嚭搴撴ā寮忓垽鏂�
 //            if (devpThread.ioMode != IoModeType.PAKOUT_MODE) { continue; }
-            if (wrkMast.getStaNo() == 204 && devpThread.ioModeOf2F != IoModeType.PAKOUT_MODE) {
-                continue;
-            }
+//            if (wrkMast.getStaNo() == 204 && devpThread.ioModeOf2F != IoModeType.PAKOUT_MODE) {
+//                continue;
+//            }
 
             // 鏌ヨ绔欑偣璇︾粏淇℃伅
             BasDevp staDetl = basDevpService.selectById(crnStn.getStaNo());
@@ -1922,8 +1640,9 @@
 //                    continue;
             }
             // 鍒ゆ柇鍫嗗灈鏈哄嚭搴撶珯鐘舵��
-            if (staProtocol.isAutoing() && !staProtocol.isLoading() && staDetl.getCanouting() != null && staDetl.getCanouting().equals("Y")
-                    && staProtocol.getWorkNo() == 0 && staProtocol.isOutEnable()) {
+            //if (staProtocol.isAutoing() && !staProtocol.isLoading() && staDetl.getCanouting() != null && staDetl.getCanouting().equals("Y")
+            //        && staProtocol.getWorkNo() == 0 && staProtocol.isOutEnable()) {
+            if (staDetl.getCanouting() != null && staDetl.getCanouting().equals("Y")) {
                 // 鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
 
                 // 鍫嗗灈鏈烘帶鍒惰繃婊�
@@ -1967,7 +1686,7 @@
                             moveLocForDeepLoc(slave, shallowLoc);
                         }
                         log.error("{}浠诲姟鍑哄簱澶辫触锛屾祬搴撲綅鍫靛锛佹祬搴撲綅鍙�:{}", wrkMast.getWrkNo(), shallowLocNo);
-                        continue;
+                        break;
                     } else if (shallowLoc.getLocSts().equals("Q") || shallowLoc.getLocSts().equals("S")) {
                         WrkMast waitWrkMast = wrkMastMapper.selectByLocNo1(shallowLocNo);
                         if (null != waitWrkMast && waitWrkMast.getWrkSts() == 4) {
@@ -1982,7 +1701,7 @@
 //                        return;
                 }
 
-                // 1.鍫嗗灈鏈哄紑濮嬬Щ鍔�
+                // 1.鍫嗗灈鏈哄紑濮嬬Щ鍔�   鍑哄簱鍛戒护
                 CrnCommand crnCommand = new CrnCommand();
                 crnCommand.setCrnNo(slave.getId()); // 鍫嗗灈鏈虹紪鍙�
                 crnCommand.setTaskNo(wrkMast.getWrkNo().shortValue()); // 宸ヤ綔鍙�
@@ -1991,9 +1710,10 @@
                 crnCommand.setSourcePosX(sourceSta.getRow1().shortValue());     // 婧愬簱浣嶆帓
                 crnCommand.setSourcePosY(sourceSta.getBay1().shortValue());     // 婧愬簱浣嶅垪
                 crnCommand.setSourcePosZ(sourceSta.getLev1().shortValue());     // 婧愬簱浣嶅眰
-                crnCommand.setDestinationPosX(crnStn.getRow().shortValue());     // 鐩爣搴撲綅鎺�
-                crnCommand.setDestinationPosY(crnStn.getBay().shortValue());     // 鐩爣搴撲綅鍒�
-                crnCommand.setDestinationPosZ(crnStn.getLev().shortValue());     // 鐩爣搴撲綅灞�
+//                crnCommand.setDestinationPosX(crnStn.getRow().shortValue());     // 鐩爣搴撲綅鎺�
+//                crnCommand.setDestinationPosY(crnStn.getBay().shortValue());     // 鐩爣搴撲綅鍒�
+//                crnCommand.setDestinationPosZ(crnStn.getLev().shortValue());     // 鐩爣搴撲綅灞�
+                crnCommand.setDestinationStaNo(crnStn.getPlatNo().shortValue());
                 if (!MessageQueue.offer(SlaveType.Crn, wrkMast.getCrnNo(), new Task(2, crnCommand))) {
                     log.error("鍫嗗灈鏈哄懡浠や笅鍙戝け璐ワ紝鍫嗗灈鏈哄彿={}锛屼换鍔℃暟鎹�={}", wrkMast.getCrnNo(), JSON.toJSON(crnCommand));
                 } else {
@@ -2010,6 +1730,69 @@
             }
         }
 
+    }
+
+    /**
+     * 纭鍑哄簱鐮佸ご鏄惁鍙敤
+     * @param wrkMast 宸ヤ綔妗�
+     * @return 鏄惁鍙敤
+     */
+    private boolean crnEnabled(WrkMast wrkMast) {
+
+        // 鑾峰彇璇锋眰澶�
+        Map<String,Object> headers = new HashMap<>();
+        headers.put("digi-type","sync ");
+        headers.put("digi-protocol","raw");
+        headers.put("digi-datakey"," XCommon.ImportData");
+
+        // 鏋勯�犺姹備綋
+        JSONObject jsonObject = new JSONObject();
+        jsonObject.put("staNo", wrkMast.getSourceStaNo());
+        jsonObject.put("workNo", wrkMast.getWrkNo());
+        String body = jsonObject.toJSONString();
+
+        boolean success;
+        String response;
+        try {
+            response = new HttpHandler.Builder()
+                    .setUri(GhjtApiConstant.GWCS_IP_PORT)
+                    .setPath(GhjtApiConstant.GWCS_CKMT_URL)
+                    .setHeaders(headers)
+                    .setJson(body)
+                    .build()
+                    .doPost();
+            if (!Cools.isEmpty(response)) {
+                JSONObject jsonObject1 = JSONObject.parseObject(response);
+                if ((Integer) jsonObject1.get("code") == 200 && (Integer) jsonObject1.get("data") == 1){
+                    success = true;
+                }else {
+                    success = false;
+                }
+            } else {
+                log.error("纭鍑哄簱鐮佸ご鏄惁鍙敤澶辫触锛侊紒锛乽rl锛歿}锛況equest锛歿}锛況esponse锛歿}", GhjtApiConstant.GWCS_IP_PORT + GhjtApiConstant.GWCS_CKMT_URL, body, response);
+                throw new CoolException("纭鍑哄簱鐮佸ご鏄惁鍙敤澶辫触");
+            }
+        } catch (Exception e) {
+            success = false;
+            log.error("纭鍑哄簱鐮佸ご鏄惁鍙敤寮傚父锛屽伐浣滃彿锛歿}锛寋}", wrkMast.getWrkNo(),e.getMessage());
+        } finally {
+
+//            try {
+//                // 淇濆瓨鎺ュ彛鏃ュ織
+//                apiLogService.save(
+//                        "浠庡嚭搴撶爜澶村埌鍑哄簱鍙�",
+//                        MesConstant.URL + MesConstant.PAKIN_URL,
+//                        null,
+//                        "127.0.0.1",
+//                        jsonObject.toJSONString(),
+//                        response,
+//                        success
+//                );
+//            } catch (Exception e) {
+//                log.error("鎺ュ彛鏃ュ織淇濆瓨寮傚父", e);
+//            }
+        }
+        return success;
     }
 
     /**
@@ -2084,201 +1867,6 @@
     }
 
     /**
-     * 鍏ュ簱  ===>>  RGV鍏ュ簱绔欏埌绔�
-     */
-    public synchronized void rgvInStn(RgvSlave slave, RgvProtocol rgvProtocol) {
-        WrkMast wrkMast = wrkMastMapper.selectRgvInSteNo(slave.getId());
-
-
-        //鏌ユ壘宸ヤ綔鐘舵�佷负2锛堣澶囦笂璧帮級,涓擱GV鍏ュ簱鎺ラ┏绔欑鍚堢殑鐨勫叆搴撳伐浣滄。锛屾彁鍙栧嚭鏈�澶�2绗�
-        List<WrkMast> wrkMastTask = getRgvInTask(slave);
-        if(wrkMastTask.size() <= 0){
-            return;
-        }
-
-        // RGV鎺у埗杩囨护锛� 蹇呴』婊¤冻鑷姩銆佺┖闂诧紝娌℃湁浠诲姟鍙�
-        if (!rgvProtocol.getStatusType().equals(CrnStatusType.IDLE)
-                || rgvProtocol.getModeType() != RgvModeType.AUTO
-                || rgvProtocol.getTaskNo1() != 0 || rgvProtocol.getTaskNo2() != 0) {
-            return;
-        }
-
-        // 宸茬粡瀛樺湪RGV鎵ц浠诲姟鏃讹紝鍒欒繃婊�
-        if(wrkMastMapper.selectRgvInWorking(slave.getId()).size() > 0){
-            return;
-        }
-
-        if(wrkMastTask.size() == 2){
-            //鏈�2绗擱GV寰呭叆搴撲换鍔★紝2涓伐浣嶏紝鍙栬揣銆佹斁璐т换鍔″悓鏃朵笅鍙�
-            WrkMast wrkMast1 = wrkMastTask.get(0);
-            WrkMast wrkMast2 = wrkMastTask.get(1);
-            if(Cools.isEmpty(wrkMast1) || Cools.isEmpty(wrkMast2)){
-                log.error("宸ヤ綔妗GV鍏ュ簱鏁版嵁涓虹┖");
-                return;
-            }
-            //  鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
-            RgvCommand rgvCommand = new RgvCommand();
-            rgvCommand.setRgvNo(slave.getId()); // RGV缂栧彿
-            rgvCommand.setAckFinish1((short) 0);  // 宸ヤ綅1浠诲姟瀹屾垚纭浣�
-            rgvCommand.setTaskNo1(wrkMast1.getWrkNo().shortValue()); // 宸ヤ綅1宸ヤ綔鍙�
-            rgvCommand.setTaskMode1(RgvTaskModeType.FETCH_PUT); // 宸ヤ綅1浠诲姟妯″紡:  鍙栨斁璐�
-            rgvCommand.setSourceStaNo1(wrkMast1.getRgvSstaNo().shortValue());   //宸ヤ綅1婧愮珯鐐�
-            rgvCommand.setDestinationStaNo1(wrkMast1.getRgvDstaNo().shortValue());   //宸ヤ綅1鐩爣绔欑偣
-            rgvCommand.setAckFinish2((short) 0);  // 宸ヤ綅2浠诲姟瀹屾垚纭浣�
-            rgvCommand.setTaskNo2(wrkMast2.getWrkNo().shortValue()); // 宸ヤ綅2宸ヤ綔鍙�
-            rgvCommand.setTaskMode2(RgvTaskModeType.FETCH_PUT); // 宸ヤ綅2浠诲姟妯″紡:  鍙栨斁璐�
-            rgvCommand.setSourceStaNo2(wrkMast2.getRgvSstaNo().shortValue());   //宸ヤ綅2婧愮珯鐐�
-            rgvCommand.setDestinationStaNo2(wrkMast2.getRgvDstaNo().shortValue());   //宸ヤ綅2鐩爣绔欑偣
-            rgvCommand.setCommand((short) 0);   //宸ヤ綅1銆�2浠诲姟纭
-            if (!MessageQueue.offer(SlaveType.Crn, wrkMast1.getRgvNo(), new Task(2, rgvCommand))) {
-                //step=2,宸ヤ綅1銆�2鍐欎换鍔★紱   step=4锛屽伐浣�1鍐欎换鍔★紱     step=5锛屽伐浣�2鍐欎换鍔�
-                log.error("RGV鍛戒护涓嬪彂澶辫触锛孯GV鍙�={}锛屼换鍔℃暟鎹�={}", slave.getId(), JSON.toJSON(rgvCommand));
-            } else {
-                // 淇敼宸ヤ綔妗g姸鎬� 2.璁惧涓婅蛋 => 6.RGV鍏ュ簱鍙栬揣涓�
-                Date now = new Date();
-                wrkMast1.setWrkSts(6L);
-                wrkMast1.setCrnStrTime(now);
-                wrkMast1.setModiTime(now);
-                if (wrkMastMapper.updateById(wrkMast1) == 0) {
-                    log.error("淇敼宸ヤ綔妗g姸鎬� 2.璁惧涓婅蛋 => 6.RGV鍏ュ簱鍙栬揣涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast1.getWrkNo());
-                }
-
-                wrkMast2.setWrkSts(6L);
-                wrkMast2.setCrnStrTime(now);
-                wrkMast2.setModiTime(now);
-                if (wrkMastMapper.updateById(wrkMast2) == 0) {
-                    log.error("淇敼宸ヤ綔妗g姸鎬� 2.璁惧涓婅蛋 => 6.RGV鍏ュ簱鍙栬揣涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast2.getWrkNo());
-                }
-            }
-        } else if(wrkMastTask.size() == 1){
-            //鍙湁1绗擱GV寰呭叆搴撲换鍔★紝鍏堜笅鍙戝彇璐т换鍔★紝鍙栬揣鍚庡啀鍒ゆ柇鏄惁鏈変笅涓�绗斿緟鍏ュ簱浠诲姟
-            WrkMast wrkMast1 = wrkMastTask.get(0);
-            if(Cools.isEmpty(wrkMast1)){
-                log.error("宸ヤ綔妗GV鍏ュ簱鏁版嵁涓虹┖");
-                return;
-            }
-            //  鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
-            RgvCommand rgvCommand = new RgvCommand();
-            rgvCommand.setRgvNo(slave.getId()); // RGV缂栧彿
-            rgvCommand.setAckFinish1((short) 0);  // 宸ヤ綅1浠诲姟瀹屾垚纭浣�
-            rgvCommand.setTaskNo1(wrkMast1.getWrkNo().shortValue()); // 宸ヤ綅1宸ヤ綔鍙�
-            rgvCommand.setTaskMode1(RgvTaskModeType.FETCH); // 宸ヤ綅1浠诲姟妯″紡:  鍙栬揣
-            rgvCommand.setSourceStaNo1(wrkMast1.getRgvSstaNo().shortValue());   //宸ヤ綅1婧愮珯鐐�
-            rgvCommand.setDestinationStaNo1(wrkMast1.getRgvDstaNo().shortValue());   //宸ヤ綅1鐩爣绔欑偣
-            rgvCommand.setCommand((short) 0);   //宸ヤ綅1銆�2浠诲姟纭
-            if (!MessageQueue.offer(SlaveType.Crn, wrkMast1.getRgvNo(), new Task(4, rgvCommand))) {
-                //step=2,宸ヤ綅1銆�2浠诲姟纭锛�   step=4锛屽伐浣�1纭锛�     step=5锛屽伐浣�2浠诲姟纭
-                log.error("RGV鍛戒护涓嬪彂澶辫触锛孯GV鍙�={}锛屼换鍔℃暟鎹�={}", slave.getId(), JSON.toJSON(rgvCommand));
-            } else {
-                // 淇敼宸ヤ綔妗g姸鎬� 2.璁惧涓婅蛋 => 6.RGV鍏ュ簱鍙栬揣涓�
-                Date now = new Date();
-                wrkMast1.setWrkSts(6L);
-                wrkMast1.setCrnStrTime(now);
-                wrkMast1.setModiTime(now);
-                if (wrkMastMapper.updateById(wrkMast1) == 0) {
-                    log.error("淇敼宸ヤ綔妗g姸鎬� 2.璁惧涓婅蛋 => 6.RGV鍏ュ簱鍙栬揣涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast1.getWrkNo());
-                }
-            }
-        }
-    }
-
-    /**
-     * 鍑哄簱  ===>>  RGV鍑哄簱绔欏埌绔�
-     */
-    public synchronized void rgvOutStn(RgvSlave slave, RgvProtocol rgvProtocol) {
-        //鏌ユ壘宸ヤ綔鐘舵�佷负14锛堝嚭搴撳畬鎴愶級,涓擱GV鍑哄簱鎺ラ┏绔欑鍚堢殑鐨勫嚭搴撳伐浣滄。锛屾彁鍙栧嚭鏈�澶�2绗�
-        List<WrkMast> wrkMastTask = getRgvOutTask(slave);
-        if(wrkMastTask.size() <= 0){
-            return;
-        }
-
-        // RGV鎺у埗杩囨护锛� 蹇呴』婊¤冻鑷姩銆佺┖闂诧紝娌℃湁浠诲姟鍙�
-        if (!rgvProtocol.getStatusType().equals(CrnStatusType.IDLE)
-                || rgvProtocol.getModeType() != RgvModeType.AUTO
-                || rgvProtocol.getTaskNo1() != 0 || rgvProtocol.getTaskNo2() != 0) {
-            return;
-        }
-
-        // 宸茬粡瀛樺湪RGV鎵ц浠诲姟鏃讹紝鍒欒繃婊�
-        if(wrkMastMapper.selectRgvOutWorking(slave.getId()).size() > 0){
-            return;
-        }
-
-        if(wrkMastTask.size() == 2){
-            //鏈�2绗擱GV寰呭叆搴撲换鍔★紝2涓伐浣嶏紝鍙栬揣銆佹斁璐т换鍔″悓鏃朵笅鍙�
-            WrkMast wrkMast1 = wrkMastTask.get(0);
-            WrkMast wrkMast2 = wrkMastTask.get(1);
-            if(Cools.isEmpty(wrkMast1) || Cools.isEmpty(wrkMast2)){
-                log.error("宸ヤ綔妗GV鍏ュ簱鏁版嵁涓虹┖");
-                return;
-            }
-            //  鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
-            RgvCommand rgvCommand = new RgvCommand();
-            rgvCommand.setRgvNo(slave.getId()); // RGV缂栧彿
-            rgvCommand.setAckFinish1((short) 0);  // 宸ヤ綅1浠诲姟瀹屾垚纭浣�
-            rgvCommand.setTaskNo1(wrkMast1.getWrkNo().shortValue()); // 宸ヤ綅1宸ヤ綔鍙�
-            rgvCommand.setTaskMode1(RgvTaskModeType.FETCH_PUT); // 宸ヤ綅1浠诲姟妯″紡:  鍙栨斁璐�
-            rgvCommand.setSourceStaNo1(wrkMast1.getRgvSstaNo().shortValue());   //宸ヤ綅1婧愮珯鐐�
-            rgvCommand.setDestinationStaNo1(wrkMast1.getRgvDstaNo().shortValue());   //宸ヤ綅1鐩爣绔欑偣
-            rgvCommand.setAckFinish2((short) 0);  // 宸ヤ綅2浠诲姟瀹屾垚纭浣�
-            rgvCommand.setTaskNo2(wrkMast2.getWrkNo().shortValue()); // 宸ヤ綅2宸ヤ綔鍙�
-            rgvCommand.setTaskMode2(RgvTaskModeType.FETCH_PUT); // 宸ヤ綅2浠诲姟妯″紡:  鍙栨斁璐�
-            rgvCommand.setSourceStaNo2(wrkMast2.getRgvSstaNo().shortValue());   //宸ヤ綅2婧愮珯鐐�
-            rgvCommand.setDestinationStaNo2(wrkMast2.getRgvDstaNo().shortValue());   //宸ヤ綅2鐩爣绔欑偣
-            rgvCommand.setCommand((short) 0);   //宸ヤ綅1銆�2浠诲姟纭
-            if (!MessageQueue.offer(SlaveType.Crn, wrkMast1.getRgvNo(), new Task(2, rgvCommand))) {
-                //step=2,宸ヤ綅1銆�2鍐欎换鍔★紱   step=4锛屽伐浣�1鍐欎换鍔★紱     step=5锛屽伐浣�2鍐欎换鍔�
-                log.error("RGV鍛戒护涓嬪彂澶辫触锛孯GV鍙�={}锛屼换鍔℃暟鎹�={}", slave.getId(), JSON.toJSON(rgvCommand));
-            } else {
-                // 淇敼宸ヤ綔妗g姸鎬� 14.鍑哄簱瀹屾垚 => 16.RGV鍑哄簱鍙栬揣涓�
-                Date now = new Date();
-                wrkMast1.setWrkSts(16L);
-                wrkMast1.setCrnStrTime(now);
-                wrkMast1.setModiTime(now);
-                if (wrkMastMapper.updateById(wrkMast1) == 0) {
-                    log.error("淇敼宸ヤ綔妗g姸鎬� 14.鍑哄簱瀹屾垚 => 16.RGV鍑哄簱鍙栬揣涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast1.getWrkNo());
-                }
-
-                wrkMast2.setWrkSts(16L);
-                wrkMast2.setCrnStrTime(now);
-                wrkMast2.setModiTime(now);
-                if (wrkMastMapper.updateById(wrkMast2) == 0) {
-                    log.error("淇敼宸ヤ綔妗g姸鎬� 14.鍑哄簱瀹屾垚 => 16.RGV鍑哄簱鍙栬揣涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast2.getWrkNo());
-                }
-            }
-        } else if(wrkMastTask.size() == 1){
-            //鍙湁1绗擱GV寰呭叆搴撲换鍔★紝鍏堜笅鍙戝彇璐т换鍔★紝鍙栬揣鍚庡啀鍒ゆ柇鏄惁鏈変笅涓�绗斿緟鍏ュ簱浠诲姟
-            WrkMast wrkMast1 = wrkMastTask.get(0);
-            if(Cools.isEmpty(wrkMast1)){
-                log.error("宸ヤ綔妗GV鍏ュ簱鏁版嵁涓虹┖");
-                return;
-            }
-            //  鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
-            RgvCommand rgvCommand = new RgvCommand();
-            rgvCommand.setRgvNo(slave.getId()); // RGV缂栧彿
-            rgvCommand.setAckFinish1((short) 0);  // 宸ヤ綅1浠诲姟瀹屾垚纭浣�
-            rgvCommand.setTaskNo1(wrkMast1.getWrkNo().shortValue()); // 宸ヤ綅1宸ヤ綔鍙�
-            rgvCommand.setTaskMode1(RgvTaskModeType.FETCH); // 宸ヤ綅1浠诲姟妯″紡:  鍙栬揣
-            rgvCommand.setSourceStaNo1(wrkMast1.getRgvSstaNo().shortValue());   //宸ヤ綅1婧愮珯鐐�
-            rgvCommand.setDestinationStaNo1(wrkMast1.getRgvDstaNo().shortValue());   //宸ヤ綅1鐩爣绔欑偣
-            rgvCommand.setCommand((short) 0);   //宸ヤ綅1銆�2浠诲姟纭
-            if (!MessageQueue.offer(SlaveType.Crn, wrkMast1.getRgvNo(), new Task(4, rgvCommand))) {
-                //step=2,宸ヤ綅1銆�2浠诲姟纭锛�   step=4锛屽伐浣�1纭锛�     step=5锛屽伐浣�2浠诲姟纭
-                log.error("RGV鍛戒护涓嬪彂澶辫触锛孯GV鍙�={}锛屼换鍔℃暟鎹�={}", slave.getId(), JSON.toJSON(rgvCommand));
-            } else {
-                // 淇敼宸ヤ綔妗g姸鎬� 14.鍑哄簱瀹屾垚 => 16.RGV鍑哄簱鍙栬揣涓�
-                Date now = new Date();
-                wrkMast1.setWrkSts(16L);
-                wrkMast1.setCrnStrTime(now);
-                wrkMast1.setModiTime(now);
-                if (wrkMastMapper.updateById(wrkMast1) == 0) {
-                    log.error("淇敼宸ヤ綔妗g姸鎬� 14.鍑哄簱瀹屾垚 => 16.RGV鍑哄簱鍙栬揣涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast1.getWrkNo());
-                }
-            }
-        }
-    }
-
-    /**
      * 鏌ユ壘宸ヤ綔鐘舵�佷负14锛堝嚭搴撳畬鎴愶級,涓擱GV鍑哄簱鎺ラ┏绔欑鍚堢殑鐨勫嚭搴撳伐浣滄。锛屾彁鍙栧嚭鏈�澶�2绗�
      * @param slave
      * @return
@@ -2350,347 +1938,6 @@
     }
 
     /**
-     * 鏍规嵁RGV瀹屾垚淇″彿锛屾墽琛屽宸ヤ綔妗g殑瀹屾垚鎿嶄綔锛屽拰RGV鐨勪换鍔′笅鍙�
-     */
-    public synchronized void rgvFinished() {
-        Date now = new Date();
-        for (RgvSlave rgv : slaveProperties.getRgv()) {
-            // 鑾峰彇RGV淇℃伅
-            RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgv.getId());
-            RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
-            if (rgvProtocol == null) {
-                continue;
-            }
-            //鍒ゆ柇RGV鏄惁绌洪棽锛屽伐浣�1鏄惁绌洪棽锛屽伐浣�1鏄惁鏈夌墿锛屾槸鍚︿负鐢佃剳妯″紡锛屽伐浣�1鏄惁鏈夊伐浣滃彿
-            if (rgvProtocol.statusType1 == RgvStatusType.FETCHWAITING
-                    && rgvProtocol.getModeType() == RgvModeType.AUTO
-                    && rgvProtocol.getTaskNo1() != 0
-                    && rgvProtocol.getStatus() != 0
-                    && rgvProtocol.getStatus1() != 0
-            ) {
-                WrkMast wrkMast1 = wrkMastMapper.selectPakInStep3(rgvProtocol.getTaskNo1().intValue());
-                if (wrkMast1 == null) {
-                    log.error("RGV宸ヤ綅1澶勪簬绛夊緟纭涓斿彇璐т换鍔″畬鎴愮姸鎬侊紝浣嗘湭鎵惧埌宸ヤ綔妗c�俁GV鍙�={}锛屽伐浣滃彿={}", rgv.getId(), rgvProtocol.getTaskNo1());
-                    continue;
-                }
-
-                if (wrkMast1.getWrkSts() == 3) {//3.RGV鍙栬揣涓� => 4.RGV鍙栬揣瀹屾垚
-                    wrkMast1.setWrkSts(4L);
-                }else if(wrkMast1.getWrkSts() == 5){//5.RGV鏀捐揣涓� => 6.RGV鏀捐揣瀹屾垚
-                    rgvProtocol.setTaskNo1((short) 0);//鍏ュ簱浠诲姟瀹屾垚锛屾竻绌轰换鍔″彿
-                    wrkMast1.setWrkSts(6L);
-                } else if (wrkMast1.getWrkSts() == 24) {//24.RGV鍙栬揣涓� => 25.RGV鍙栬揣瀹屾垚
-                    wrkMast1.setWrkSts(25L);//
-                } else if (wrkMast1.getWrkSts() == 26) {//26.RGV鏀捐揣涓� => 27.RGV鏀捐揣瀹屾垚
-                    rgvProtocol.setTaskNo1((short) 0);//鍑哄簱浠诲姟瀹屾垚锛屾竻绌轰换鍔″彿
-                    wrkMast1.setWrkSts(27L);//27.RGV鏀捐揣瀹屾垚
-                }
-
-                //瑙i攣璺緞
-                RgvUtils.unLockPath(wrkMast1.getRgvNo());
-
-                wrkMast1.setModiTime(now);
-                if (wrkMastMapper.updateById(wrkMast1) == 0) {
-                    log.error("宸ヤ綅1淇敼宸ヤ綔妗g姸鎬佸け璐ワ紒锛侊紝宸ヤ綔鍙�={}", wrkMast1.getWrkNo());
-                }
-
-                //  鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
-                RgvCommand rgvCommand = new RgvCommand();
-                rgvCommand.setRgvNo(rgv.getId()); // RGV缂栧彿
-                rgvCommand.setAckFinish1((short) 1);  // 宸ヤ綅1浠诲姟瀹屾垚纭浣�
-                rgvCommand.setTaskNo1(wrkMast1.getWrkNo().shortValue()); // 宸ヤ綅1宸ヤ綔鍙�
-                rgvCommand.setTaskMode1(RgvTaskModeType.NONE); // 宸ヤ綅1浠诲姟妯″紡:  鏃�
-                rgvCommand.setCommand((short) 1);   //宸ヤ綅1浠诲姟纭
-                if (!MessageQueue.offer(SlaveType.Crn, wrkMast1.getRgvNo(), new Task(4, rgvCommand))) {
-                    //step=2,宸ヤ綅1銆�2浠诲姟纭锛�   step=4锛屽伐浣�1纭锛�     step=5锛屽伐浣�2浠诲姟纭
-                    log.error("RGV鍛戒护涓嬪彂澶辫触锛孯GV鍙�={}锛屼换鍔℃暟鎹�={}", rgv.getId(), JSON.toJSON(rgvCommand));
-                }
-
-//                //宸ヤ綅1鍙栬揣瀹屾垚鍚庯紝宸ヤ綅2鏄棤璐х┖闂茬姸鎬佹椂锛屽噯澶囩粰宸ヤ綅2鍙戜换鍔★紝纭鏄惁鏈夊緟鎵цRGV浠诲姟
-//                if (rgvProtocol.getModeType() == RgvModeType.AUTO
-//                        && rgvProtocol.getTaskNo1() > 0 && rgvProtocol.getTaskNo2() == 0
-//                        && rgvProtocol.getLoaded1() > 0 && rgvProtocol.getLoaded2() == 0
-//                        && rgvProtocol.getStatusType2() == RgvStatusType.IDLE
-//                ) {
-//                    WrkMast wrkMast1 = wrkMastMapper.selectPakInStep3(rgvProtocol.getTaskNo1().intValue());
-//                    if (wrkMast1 == null) {
-//                        log.error("RGV宸ヤ綅1澶勪簬绛夊緟纭涓斿彇璐т换鍔″畬鎴愮姸鎬侊紝浣嗘湭鎵惧埌宸ヤ綔妗c�俁GV鍙�={}锛屽伐浣滃彿={}", rgv.getId(), rgvProtocol.getTaskNo1());
-//                        continue;
-//                    }
-//                    List<WrkMast> wrkMastTask = new ArrayList<>();
-//                    List<WrkMast> list = new ArrayList<>();
-//                    Integer type = 0;//1鍏ュ簱锛�2鍑哄簱
-//                    if(wrkMast1.getWrkSts()==6L){
-//                        wrkMastTask = getRgvInTask(rgv);
-//                        list = wrkMastMapper.selectRgvInWorking(rgv.getId());
-//                        type = 1;
-//                    } else if(wrkMast1.getWrkSts()==16L){
-//                        wrkMastTask = getRgvOutTask(rgv);
-//                        list = wrkMastMapper.selectRgvOutWorking(rgv.getId());
-//                        type = 2;
-//                    }
-//                    if(wrkMastTask.size() > 0){//鏈夌户缁墽琛屼换鍔★紝涓嬪彂鍙栬揣浠诲姟缁欏伐浣�2
-//                        // 宸茬粡瀛樺湪RGV鎵ц浠诲姟鏃讹紝鍒欒繃婊�
-//                        if (list.size() > 1) {
-//                            continue;
-//                        }
-//                        WrkMast wrkMast2 = wrkMastTask.get(0);
-//                        //  鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
-//                        RgvCommand rgvCommand = new RgvCommand();
-//                        rgvCommand.setRgvNo(rgv.getId()); // RGV缂栧彿
-//                        rgvCommand.setAckFinish2((short) 0);  // 宸ヤ綅2浠诲姟瀹屾垚纭浣�
-//                        rgvCommand.setTaskNo2(wrkMast2.getWrkNo().shortValue()); // 宸ヤ綅2宸ヤ綔鍙�
-//                        rgvCommand.setTaskMode2(RgvTaskModeType.FETCH); // 宸ヤ綅2浠诲姟妯″紡:  鍙栬揣
-//                        rgvCommand.setSourceStaNo2(wrkMast2.getRgvSstaNo().shortValue());   //宸ヤ綅2婧愮珯鐐�
-//                        rgvCommand.setDestinationStaNo2(wrkMast2.getRgvDstaNo().shortValue());   //宸ヤ綅2鐩爣绔欑偣
-//                        rgvCommand.setCommand((short) 0);   //宸ヤ綅1銆�2浠诲姟纭
-//                        if (!MessageQueue.offer(SlaveType.Crn, wrkMast2.getRgvNo(), new Task(5, rgvCommand))) {
-//                            //step=2,宸ヤ綅1銆�2鍐欎换鍔★紱   step=4锛屽伐浣�1鍐欎换鍔★紱     step=5锛屽伐浣�2鍐欎换鍔�
-//                            log.error("RGV鍛戒护涓嬪彂澶辫触锛孯GV鍙�={}锛屼换鍔℃暟鎹�={}", rgv.getId(), JSON.toJSON(rgvCommand));
-//                        } else {
-//                            // 淇敼宸ヤ綔妗g姸鎬� 2.璁惧涓婅蛋 => 6.RGV鍏ュ簱鍙栬揣涓�
-//                            Date now = new Date();
-//                            wrkMast2.setWrkSts(type==1 ? 6L : 16L);
-//                            wrkMast2.setCrnStrTime(now);
-//                            wrkMast2.setModiTime(now);
-//                            if (wrkMastMapper.updateById(wrkMast2) == 0) {
-//                                log.error("宸ヤ綅2淇敼宸ヤ綔妗g姸鎬� 2/14.璁惧涓婅蛋 => 6/16.RGV鍏ュ簱鍙栬揣涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast2.getWrkNo());
-//                            }
-//                        }
-//                    } else {//娌℃湁缁х画鎵ц浠诲姟锛屼笅鍙戞斁璐т换鍔$粰宸ヤ綅1
-//                        if(type == 1 && wrkMast1.getWrkSts() != 6L){//RGV鍏ュ簱鍙栬揣涓�
-//                            continue;
-//                        }
-//                        if(type == 2 && wrkMast1.getWrkSts() != 16L){//RGV鍑哄簱鍙栬揣涓�
-//                            continue;
-//                        }
-//
-//                        //  鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
-//                        RgvCommand rgvCommand = new RgvCommand();
-//                        rgvCommand.setRgvNo(rgv.getId()); // RGV缂栧彿
-//                        rgvCommand.setAckFinish1((short) 0);  // 宸ヤ綅1浠诲姟瀹屾垚纭浣�
-//                        rgvCommand.setTaskNo1(wrkMast1.getWrkNo().shortValue()); // 宸ヤ綅1宸ヤ綔鍙�
-//                        rgvCommand.setTaskMode1(RgvTaskModeType.PUT); // 宸ヤ綅1浠诲姟妯″紡:  鏀捐揣
-//                        rgvCommand.setSourceStaNo1(wrkMast1.getRgvSstaNo().shortValue());   //宸ヤ綅1婧愮珯鐐�
-//                        rgvCommand.setDestinationStaNo1(wrkMast1.getRgvDstaNo().shortValue());   //宸ヤ綅1鐩爣绔欑偣
-//                        rgvCommand.setCommand((short) 0);   //宸ヤ綅1銆�2浠诲姟纭
-//                        if (!MessageQueue.offer(SlaveType.Crn, wrkMast1.getRgvNo(), new Task(4, rgvCommand))) {
-//                            //step=2,宸ヤ綅1銆�2浠诲姟纭锛�   step=4锛屽伐浣�1纭锛�     step=5锛屽伐浣�2浠诲姟纭
-//                            log.error("RGV鍛戒护涓嬪彂澶辫触锛孯GV鍙�={}锛屼换鍔℃暟鎹�={}", rgv.getId(), JSON.toJSON(rgvCommand));
-//                        } else {
-//                            // 淇敼宸ヤ綔妗g姸鎬� 6.RGV鍏ュ簱鍙栬揣涓� => 7.RGV鍏ュ簱鏀捐揣涓�
-//                            Date now = new Date();
-//                            wrkMast1.setWrkSts(type==1 ? 7L : 17L);
-//                            wrkMast1.setCrnEndTime(now);
-//                            wrkMast1.setModiTime(now);
-//                            if (wrkMastMapper.updateById(wrkMast1) == 0) {
-//                                log.error("淇敼宸ヤ綔妗g姸鎬� 6/16.RGV鍏ュ簱鍙栬揣涓� => 7/17.RGV鍏ュ簱鏀捐揣涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast1.getWrkNo());
-//                            }
-//                            log.error("RGV鍛戒护涓嬪彂鎴愬姛锛孯GV鍙�={}锛屼换鍔℃暟鎹�={}", rgv.getId(), JSON.toJSON(rgvCommand));
-//                        }
-//                    }
-//                } else if (rgvProtocol.getModeType() == RgvModeType.AUTO
-//                        && rgvProtocol.getTaskNo1() > 0 && rgvProtocol.getTaskNo2() > 0
-//                        && rgvProtocol.getLoaded1() > 0 && rgvProtocol.getLoaded2() > 0
-//                        && rgvProtocol.statusType2 == RgvStatusType.FETCHWAITING){
-//                    //  宸ヤ綅2鐘舵�侊細涔熸槸鍙栬揣瀹屾垚绛夊緟纭91 骞朵笖  浠诲姟瀹屾垚浣� = 1,  宸ヤ綅1銆�2鍚屾椂涓嬪彂鏀捐揣浠诲姟
-//                    WrkMast wrkMast1 = wrkMastMapper.selectPakInStep3(rgvProtocol.getTaskNo1().intValue());
-//                    WrkMast wrkMast2 = wrkMastMapper.selectPakInStep3(rgvProtocol.getTaskNo2().intValue());
-//                    //  鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
-//                    RgvCommand rgvCommand = new RgvCommand();
-//                    rgvCommand.setRgvNo(rgv.getId()); // RGV缂栧彿
-//                    rgvCommand.setAckFinish1((short) 0);  // 宸ヤ綅1浠诲姟瀹屾垚纭浣�
-//                    rgvCommand.setTaskNo1(wrkMast1.getWrkNo().shortValue()); // 宸ヤ綅1宸ヤ綔鍙�
-//                    rgvCommand.setTaskMode1(RgvTaskModeType.PUT); // 宸ヤ綅1浠诲姟妯″紡:  鏀捐揣
-//                    rgvCommand.setSourceStaNo1(wrkMast1.getRgvSstaNo().shortValue());   //宸ヤ綅1婧愮珯鐐�
-//                    rgvCommand.setDestinationStaNo1(wrkMast1.getRgvDstaNo().shortValue());   //宸ヤ綅1鐩爣绔欑偣
-//                    rgvCommand.setAckFinish2((short) 0);  // 宸ヤ綅2浠诲姟瀹屾垚纭浣�
-//                    rgvCommand.setTaskNo2(wrkMast2.getWrkNo().shortValue()); // 宸ヤ綅2宸ヤ綔鍙�
-//                    rgvCommand.setTaskMode2(RgvTaskModeType.PUT); // 宸ヤ綅2浠诲姟妯″紡:  鏀捐揣
-//                    rgvCommand.setSourceStaNo2(wrkMast2.getRgvSstaNo().shortValue());   //宸ヤ綅2婧愮珯鐐�
-//                    rgvCommand.setDestinationStaNo2(wrkMast2.getRgvDstaNo().shortValue());   //宸ヤ綅2鐩爣绔欑偣
-//                    rgvCommand.setCommand((short) 0);   //宸ヤ綅1銆�2浠诲姟纭
-//                    if (!MessageQueue.offer(SlaveType.Crn, wrkMast1.getRgvNo(), new Task(2, rgvCommand))) {
-//                        //step=2,宸ヤ綅1銆�2浠诲姟纭锛�   step=4锛屽伐浣�1纭锛�     step=5锛屽伐浣�2浠诲姟纭
-//                        log.error("RGV鍛戒护涓嬪彂澶辫触锛孯GV鍙�={}锛屼换鍔℃暟鎹�={}", rgv.getId(), JSON.toJSON(rgvCommand));
-//                    } else {
-//                        // 淇敼宸ヤ綔妗g姸鎬� 2.璁惧涓婅蛋 => 6.RGV鍏ュ簱鍙栬揣涓�
-//                        Date now = new Date();
-//                        wrkMast1.setWrkSts(wrkMast1.getWrkSts()==6L ? 7L : 17L);
-//                        wrkMast1.setCrnStrTime(now);
-//                        wrkMast1.setModiTime(now);
-//                        if (wrkMastMapper.updateById(wrkMast1) == 0) {
-//                            log.error("淇敼宸ヤ綔妗g姸鎬� 6/16.RGV鍏ュ簱鍙栬揣涓� => 7/17.RGV鍏ュ簱鏀捐揣涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast1.getWrkNo());
-//                        }
-//
-//                        wrkMast2.setWrkSts(wrkMast2.getWrkSts()==6L ? 7L : 17L);
-//                        wrkMast2.setCrnStrTime(now);
-//                        wrkMast2.setModiTime(now);
-//                        if (wrkMastMapper.updateById(wrkMast2) == 0) {
-//                            log.error("淇敼宸ヤ綔妗g姸鎬� 6/16.RGV鍏ュ簱鍙栬揣涓� => 7/17.RGV鍏ュ簱鏀捐揣涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast2.getWrkNo());
-//                        }
-//                    }
-//                }
-            }
-
-        }
-    }
-
-    /**
-     * 鍏ュ嚭搴�  ===>>  RGV鍑哄簱绔欏埌鍫嗗灈鏈哄叆搴撶珯/绯荤粺鍏ュ簱绔�
-     * rgvInDStnToCrnStn
-     */
-    public synchronized void rgvDestStnToCrnStn() {
-        for (RgvSlave rgvSlave : slaveProperties.getRgv()) {
-            // 閬嶅巻鍏ュ簱浠诲姟鐨凴GV鍑哄簱绔�
-            for (RgvSlave.RgvStn rgvStn : rgvSlave.getRgvDestStn()) {
-                // 鑾峰彇RGV鍑哄簱绔欎俊鎭�
-                DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, rgvStn.getDevpPlcId());
-                StaProtocol staProtocol = devpThread.getStation().get(rgvStn.getStaNo());
-                if (staProtocol == null) {
-                    continue;
-                } else {
-                    staProtocol = staProtocol.clone();
-                }
-                if (staProtocol.isAutoing() && staProtocol.isLoading() && (staProtocol.getWorkNo() == 0 || staProtocol.getStaNo() == null)) {
-                    // 鏌ヨ宸ヤ綔妗ist
-//                    List<WrkMast> wrkMasts = wrkMastMapper.selectRgvInStep2(staProtocol.getSiteId());
-                    List<WrkMast> wrkMasts = wrkMastMapper.selectRgvDestStep2(staProtocol.getSiteId());
-                    for(WrkMast wrkMast : wrkMasts){
-                        // 鍒ゆ柇宸ヤ綔妗f潯浠�
-                        if (wrkMast.getStaNo() == null || wrkMast.getSourceStaNo() == null
-                            || wrkMast.getRgvSstaNo() == null || wrkMast.getRgvDstaNo() == null) {
-                            continue;
-                        }
-
-                        RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, wrkMast.getRgvNo());
-                        RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
-                        //  鍒ゆ柇RGV鐘舵�佺瓑寰呯‘璁�,宸ヤ綅1
-                        if (rgvProtocol.modeType == RgvModeType.AUTO && rgvProtocol.getTaskNo1().equals(wrkMast.getWrkNo().shortValue())
-                                && rgvProtocol.statusType1 == RgvStatusType.WAITING) {
-                            // 鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
-                            // 涓嬪彂绔欑偣淇℃伅
-                            staProtocol.setWorkNo(wrkMast.getWrkNo());
-                            staProtocol.setStaNo(wrkMast.getStaNo());
-                            if (!MessageQueue.offer(SlaveType.Devp, rgvStn.getDevpPlcId(), new Task(2, staProtocol))) {
-                                continue;
-                            }
-                            // 鏇存柊宸ヤ綔妗g姸鎬佷负2,14
-                            wrkMast.setWrkSts(wrkMast.getWrkSts()==7L ? 2L : 14L);
-                            wrkMast.setOnlineYn("Y");
-                            wrkMast.setCrnEndTime(new Date());
-                            if (wrkMastMapper.updateById(wrkMast) != 0) {
-                                // 澶嶄綅RGV宸ヤ綅1
-                                rgvThread.setResetFlag1(true);
-                            } else {
-                                log.error("RGV宸ヤ綅1鎺ラ┏锛屾洿鏂板伐浣滄。鐨勫伐浣滅姸鎬佷负{}澶辫触锛侊紒锛� [宸ヤ綔鍙�:{}]", wrkMast.getWrkSts()==7L ? 2L : 14L, wrkMast.getWrkNo());
-                            }
-                        }
-                        //  鍒ゆ柇RGV鐘舵�佺瓑寰呯‘璁�,宸ヤ綅2
-                        if (rgvProtocol.modeType == RgvModeType.AUTO && rgvProtocol.getTaskNo2().equals(wrkMast.getWrkNo().shortValue())
-                                && rgvProtocol.statusType2 == RgvStatusType.WAITING) {
-                            // 鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
-                            // 涓嬪彂绔欑偣淇℃伅
-                            staProtocol.setWorkNo(wrkMast.getWrkNo());
-                            staProtocol.setStaNo(wrkMast.getStaNo());
-                            if (!MessageQueue.offer(SlaveType.Devp, rgvStn.getDevpPlcId(), new Task(2, staProtocol))) {
-                                continue;
-                            }
-                            // 鏇存柊宸ヤ綔妗g姸鎬佷负2,14
-                            wrkMast.setWrkSts(wrkMast.getWrkSts()==7L ? 2L : 14L);
-                            wrkMast.setOnlineYn("Y");
-                            wrkMast.setCrnEndTime(new Date());
-                            if (wrkMastMapper.updateById(wrkMast) != 0) {
-                                // 澶嶄綅RGV宸ヤ綅2
-                                rgvThread.setResetFlag2(true);
-                            } else {
-                                log.error("RGV宸ヤ綅2鎺ラ┏锛屾洿鏂板伐浣滄。鐨勫伐浣滅姸鎬佷负{}澶辫触锛侊紒锛� [宸ヤ綔鍙�:{}]", wrkMast.getWrkSts()==7L ? 2L : 14L, wrkMast.getWrkNo());
-                            }
-                        }
-                    }
-
-                }
-            }
-        }
-    }
-
-    /**
-     * 鍑哄簱  ===>>  RGV鍑哄簱绔欏埌绯荤粺鍑哄簱绔�
-     */
-    public synchronized void rgvOutDStnToOutStn() {
-        for (RgvSlave rgvSlave : slaveProperties.getRgv()) {
-            // 閬嶅巻鍑哄簱浠诲姟鐨凴GV鍑哄簱绔�
-            for (RgvSlave.RgvStn rgvStn : rgvSlave.getRgvDestStn()) {
-                // 鑾峰彇RGV鍑哄簱绔欎俊鎭�
-                DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, rgvStn.getDevpPlcId());
-                StaProtocol staProtocol = devpThread.getStation().get(rgvStn.getStaNo());
-                if (staProtocol == null) {
-                    continue;
-                } else {
-                    staProtocol = staProtocol.clone();
-                }
-                if (staProtocol.isAutoing() && staProtocol.isLoading() && (staProtocol.getWorkNo() == 0 || staProtocol.getStaNo() == null)) {
-                    // 鏌ヨ宸ヤ綔妗ist
-                    List<WrkMast> wrkMasts = wrkMastMapper.selectRgvOutStep2(staProtocol.getSiteId());
-                    for(WrkMast wrkMast : wrkMasts){
-                        // 鍒ゆ柇宸ヤ綔妗f潯浠�
-                        if (wrkMast.getIoType() < 100 || wrkMast.getStaNo() == null || wrkMast.getSourceStaNo() == null
-                                || wrkMast.getRgvSstaNo() == null || wrkMast.getRgvDstaNo() == null) {
-                            continue;
-                        }
-
-                        RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, wrkMast.getRgvNo());
-                        RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
-                        //  鍒ゆ柇RGV鐘舵�佺瓑寰呯‘璁�,宸ヤ綅1
-                        if (rgvProtocol.modeType == RgvModeType.AUTO && rgvProtocol.getTaskNo1().equals(wrkMast.getWrkNo().shortValue())
-                                && rgvProtocol.statusType1 == RgvStatusType.WAITING) {
-                            // 鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
-                            // 涓嬪彂绔欑偣淇℃伅
-                            staProtocol.setWorkNo(wrkMast.getWrkNo());
-                            staProtocol.setStaNo(wrkMast.getStaNo());
-                            if (!MessageQueue.offer(SlaveType.Devp, rgvStn.getDevpPlcId(), new Task(2, staProtocol))) {
-                                continue;
-                            }
-                            // 鏇存柊宸ヤ綔妗g姸鎬佷负14
-                            wrkMast.setWrkSts(14L);
-                            wrkMast.setOnlineYn("Y");   //鎺у埗WMS灏嗗伐浣滅姸鎬�14杞�15鐨勬椂鏈猴紝鍙湁RGV杩愭惉瀹屾垚鍚庢墠鍙互杞�
-                            wrkMast.setCrnEndTime(new Date());
-                            if (wrkMastMapper.updateById(wrkMast) != 0) {
-                                // 澶嶄綅RGV宸ヤ綅1
-                                rgvThread.setResetFlag1(true);
-                            } else {
-                                log.error("RGV宸ヤ綅1鎺ラ┏锛屾洿鏂板伐浣滄。鐨勫伐浣滅姸鎬佷负2澶辫触锛侊紒锛� [宸ヤ綔鍙�:{}]", wrkMast.getWrkNo());
-                            }
-                        }
-                        //  鍒ゆ柇RGV鐘舵�佺瓑寰呯‘璁�,宸ヤ綅2
-                        if (rgvProtocol.modeType == RgvModeType.AUTO && rgvProtocol.getTaskNo2().equals(wrkMast.getWrkNo().shortValue())
-                                && rgvProtocol.statusType2 == RgvStatusType.WAITING) {
-                            // 鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
-                            // 涓嬪彂绔欑偣淇℃伅
-                            staProtocol.setWorkNo(wrkMast.getWrkNo());
-                            staProtocol.setStaNo(wrkMast.getStaNo());
-                            if (!MessageQueue.offer(SlaveType.Devp, rgvStn.getDevpPlcId(), new Task(2, staProtocol))) {
-                                continue;
-                            }
-                            // 鏇存柊宸ヤ綔妗g姸鎬佷负14
-                            wrkMast.setWrkSts(14L);
-                            wrkMast.setOnlineYn("Y");   //鎺у埗WMS灏嗗伐浣滅姸鎬�14杞�15鐨勬椂鏈猴紝鍙湁RGV杩愭惉瀹屾垚鍚庢墠鍙互杞�
-                            wrkMast.setCrnEndTime(new Date());
-                            if (wrkMastMapper.updateById(wrkMast) != 0) {
-                                // 澶嶄綅RGV宸ヤ綅2
-                                rgvThread.setResetFlag2(true);
-                            } else {
-                                log.error("RGV宸ヤ綅2鎺ラ┏锛屾洿鏂板伐浣滄。鐨勫伐浣滅姸鎬佷负2澶辫触锛侊紒锛� [宸ヤ綔鍙�:{}]", wrkMast.getWrkNo());
-                            }
-                        }
-                    }
-
-                }
-            }
-        }
-    }
-
-    /**
      * 搴撲綅绉昏浆
      */
     public synchronized void locToLoc(CrnSlave slave, CrnProtocol crnProtocol) {
@@ -2724,6 +1971,49 @@
         // 鍫嗗灈鏈烘帶鍒惰繃婊�
         if (!crnProtocol.getStatusType().equals(CrnStatusType.IDLE) || crnProtocol.getTaskNo() != 0) {
             return;
+        }
+        // 鍙屾繁搴撲綅涓旀祬搴撲綅鏈夎揣锛屽垯闇�鍏堝娴呭簱浣嶈繘琛屽簱浣嶇Щ杞�
+        if (Utils.isDeepLoc(slaveProperties, wrkMast.getSourceLocNo())) {
+            String shallowLocNo = Utils.getShallowLoc(slaveProperties, wrkMast.getSourceLocNo());
+            LocMast shallowLoc = locMastService.selectById(shallowLocNo);
+            // O.绌哄簱浣嶃�丵.鎷f枡/鐩樼偣/骞舵澘鍐嶅叆搴撱�丼.鍏ュ簱棰勭害銆乆.绂佺敤 鐩存帴鎼紒
+            if (shallowLoc.getLocSts().equals("P") || shallowLoc.getLocSts().equals("R")) {
+                WrkMast waitWrkMast = wrkMastMapper.selectByLocNo(shallowLocNo);
+                if (null == waitWrkMast) {
+                    log.error("{}搴撲綅寮傚父锛屾湭妫�绱㈠埌鐩稿簲宸ヤ綔妗o紒", shallowLocNo);
+                } else {
+                    if (waitWrkMast.getWrkSts() == 11) {
+                        waitWrkMast.setIoPri(15D);
+                        waitWrkMast.setModiTime(new Date());
+                        if (wrkMastMapper.updateById(waitWrkMast) == 0) {
+                            log.error("璋冩暣宸ヤ綔妗d紭鍏堢骇澶辫触锛佸伐浣滃彿={}", waitWrkMast.getWrkNo());
+                        }
+                       return;
+                    } else {
+
+                    }
+                }
+            } else if (shallowLoc.getLocSts().equals("F") || shallowLoc.getLocSts().equals("D")) {
+//                            WrkMast waitWrkMast = wrkMastMapper.selectByLocNo(shallowLocNo);
+                //2022-08-16 modify,涓嶆牴鎹畊pdmk鏍囪绉诲簱浠诲姟(瀹规槗琚彇娑堝鑷村牭濉�)锛屾煡璇㈠伐浣滄。鏄惁瀛樺湪浠诲姟
+                WrkMast waitWrkMast = wrkMastMapper.selectByLocNo1(shallowLocNo);
+                // 姝ゆ爣璁伴伩鍏嶅娆℃墽琛岀Щ搴撲换鍔�
+//                            if (Cools.isEmpty(wrkMast.getUpdMk()) || "N".equals(wrkMast.getUpdMk())
+//                                || Cools.isEmpty(waitWrkMast)) {
+                if (Cools.isEmpty(waitWrkMast)) {
+                    wrkMast.setUpdMk("Y");
+                    wrkMastMapper.updateById(wrkMast);
+                    // 鐢熸垚宸ヤ綔妗�,灏嗘祬搴撲綅绉昏浆鍒版柊鐨勫簱浣嶄腑
+                    moveLocForDeepLoc(slave, shallowLoc);
+                }
+                log.error("{}浠诲姟鍑哄簱澶辫触锛屾祬搴撲綅鍫靛锛佹祬搴撲綅鍙�:{}", wrkMast.getWrkNo(), shallowLocNo);
+                return;
+            } else if (shallowLoc.getLocSts().equals("Q") || shallowLoc.getLocSts().equals("S")) {
+                WrkMast waitWrkMast = wrkMastMapper.selectByLocNo1(shallowLocNo);
+                if (null != waitWrkMast && waitWrkMast.getWrkSts() == 4) {
+                    return;
+                }
+            }
         }
 
         // 宸茬粡瀛樺湪鍚婅溅鎵ц浠诲姟鏃讹紝鍒欒繃婊�
@@ -2784,6 +2074,9 @@
                     // 鍏ュ簱 + 搴撲綅杞Щ  ==> 4.鍏ュ簱瀹屾垚
                     if (wrkMast.getWrkSts() == 3 || (wrkMast.getWrkSts() == 12 && wrkMast.getIoType() == 11)) {
                         wrkMast.setWrkSts(4L);
+                        if (wrkMast.getIoType() == 3) {
+                            wrkMast.setWrkSts(13L);
+                        }
                     } else {
                         continue;
                     }
@@ -3153,6 +2446,10 @@
      */
     public synchronized void storeEmptyPlt3() {
         try{
+            RgvOneSign rgvOneSign = rgvOneSignMapper.selectOneSign();
+            if (Cools.isEmpty(rgvOneSign) || rgvOneSign.getRgvOneSign()==1){
+                return;
+            }
             for (RgvSlave rgvSlave:slaveProperties.getRgv()) {
                 RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgvSlave.getId());
                 RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
@@ -3171,7 +2468,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灞傞兘鏈夌墿
+//                        &&  (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);
@@ -3184,6 +2482,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")
@@ -3275,6 +2574,10 @@
                         ledCommand.setTitle("绌烘澘鍑哄簱");
                         ledCommand.setEmptyMk(true);
                         break;
+                    case 212:
+                        ledCommand.setTitle("绌烘澘鍑哄簱");
+                        ledCommand.setEmptyMk(true);
+                        break;
                     default:
                         log.error("浠诲姟鍏ュ嚭搴撶被鍨嬮敊璇紒锛侊紒[宸ヤ綔鍙凤細{}] [鍏ュ嚭搴撶被鍨嬶細{}]", wrkMast.getWrkNo(), wrkMast.getIoType());
                         break;
@@ -3292,10 +2595,10 @@
             Set<Integer> workNos = wrkMasts.stream().map(WrkMast::getWrkNo).collect(Collectors.toSet());
             // 鑾峰彇LED绾跨▼
             LedThread ledThread = (LedThread) SlaveConnection.get(SlaveType.Led, led.getId());
-//            // 鐩稿悓宸ヤ綔鍙烽泦鍚堝垯杩囨护
-//            if (CollectionUtils.equals(ledThread.getWorkNos(), workNos)) {
-//                continue;
-//            }
+            // 鐩稿悓宸ヤ綔鍙烽泦鍚堝垯杩囨护
+            if (CollectionUtils.equals(ledThread.getWorkNos(), workNos)) {
+                continue;
+            }
             // 鍛戒护涓嬪彂 -------------------------------------------------------------------------------
             if (!commands.isEmpty()) {
 //                if (led.getId() == 7) {
@@ -3465,9 +2768,18 @@
         try {
             List<Integer> rows = locMastService.queryDistinctRow(crn.getId());
             LocMast loc = null;
+
+            // 鑾峰彇澶囪揣鍖洪厤缃�
+            Config config = configMapper.selectConfigByCode("auto_stock_up");
+            if (config == null) {
+                return;
+            }
+            // 澶囪揣鍙栨槸鍓嶅嚑鍒�
+            int bay1 = Integer.parseInt(config.getValue());
+
             for (Integer row : rows) {
                 if (Utils.isDeepLoc(slaveProperties, row)) {
-                    loc = locMastService.queryFreeLocMast(row, shallowLoc.getLocType1());
+                    loc = locMastService.queryFreeLocMastNotBay(row, shallowLoc.getLocType1(),bay1);
 
                     if (loc != null) {
                         if (Utils.isDeepLoc(slaveProperties, loc.getLocNo())) {
@@ -3486,7 +2798,7 @@
             if (null == loc) {
                 for (Integer row : rows) {
                     if (Utils.isShallowLoc(slaveProperties, row)) {
-                        loc = locMastService.queryFreeLocMast(row, shallowLoc.getLocType1());
+                        loc = locMastService.queryFreeLocMastNotBay(row, shallowLoc.getLocType1(),bay1);
 
                         if (null != loc) {//瀵瑰簲娣卞簱浣嶉潪鍦ㄥ簱鐘舵��,涓嶈兘绉诲簱
                             String deepLoc = Utils.getDeepLoc(slaveProperties, loc.getLocNo());
@@ -3505,68 +2817,69 @@
 
             if (null == loc) {
                 log.error("鍙屾繁搴撲綅 --- 娴呭簱浣嶉樆濉炲紓甯革紒 寰呯Щ杞祬搴撲綅锛�" + shallowLoc.getLocNo());
-                throw new CoolException("鍙屾繁搴撲綅 --- 娴呭簱浣嶉樆濉炲紓甯革紒 寰呯Щ杞祬搴撲綅锛�" + shallowLoc.getLocNo());
-            }
+//                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槑缁嗗け璐�");
+                // 鑾峰彇宸ヤ綔鍙�
+                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);
@@ -3575,26 +2888,26 @@
         }
     }
 
-    /**
-     * 鍒濆鍖朢GV鍦板浘
-     */
-    public synchronized void initRgvMap() {
-        Object data = redisUtil.get("rgv_map");
-        if (data == null) {
-            //閲嶆柊鑾峰彇鍏ㄨ矾寰勫湴鍥�
-            BasRgvPath basRgvPath = basRgvPathService.selectByRgvNo(0);//鑾峰彇榛樿璺緞
-            if (basRgvPath != null) {
-                ArrayList<RgvNode> rgvNodes = new ArrayList<>();
-                List<Integer> rgvPath = JSON.parseArray(basRgvPath.getPath(), Integer.class);
-                for (Integer integer : rgvPath) {
-                    RgvNode rgvNode = new RgvNode(integer);
-                    rgvNodes.add(rgvNode);
-                }
-                //灏嗘暟鎹簱鍦板浘鏁版嵁瀛樺叆redis
-                redisUtil.set("rgv_map", JSON.toJSONString(rgvNodes));
-            }
-        }
-    }
+//    /**
+//     * 鍒濆鍖朢GV鍦板浘
+//     */
+//    public synchronized void initRgvMap() {
+//        Object data = redisUtil.get("rgv_map");
+//        if (data == null) {
+//            //閲嶆柊鑾峰彇鍏ㄨ矾寰勫湴鍥�
+//            BasRgvPath basRgvPath = basRgvPathService.selectByRgvNo(0);//鑾峰彇榛樿璺緞
+//            if (basRgvPath != null) {
+//                ArrayList<RgvNode> rgvNodes = new ArrayList<>();
+//                List<Integer> rgvPath = JSON.parseArray(basRgvPath.getPath(), Integer.class);
+//                for (Integer integer : rgvPath) {
+//                    RgvNode rgvNode = new RgvNode(integer);
+//                    rgvNodes.add(rgvNode);
+//                }
+//                //灏嗘暟鎹簱鍦板浘鏁版嵁瀛樺叆redis
+//                redisUtil.set("rgv_map", JSON.toJSONString(rgvNodes));
+//            }
+//        }
+//    }
 
     /**
      * 鍫嗗灈鏈烘紨绀�  ===>> 搴撲綅绉昏浆
@@ -3810,97 +3123,6 @@
 
     }
 
-    public synchronized void outOfDevp() {
-        List<WrkMast> wrkMasts = wrkMastMapper.selectPick();
-        for (WrkMast wrkMast : wrkMasts) {
-            if (basDevpService.selectCount(new EntityWrapper<BasDevp>().eq("wrk_no", wrkMast.getWrkNo())) == 0) {
-                wrkMast.setCtnNo("Y");
-                if (wrkMastMapper.updateById(wrkMast) == 0) {
-                    log.error("淇敼{}宸ヤ綔妗eけ璐ワ紝ctn_no", wrkMast.getWrkNo());
-                }
-            }
-
-        }
-    }
-
-
-    public synchronized void autoEmptyOut() {
-        DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, 1);
-        Integer autoOutSite = 12;
-        //濡傛灉绔欑偣鍙嚭绂佺敤锛屽垯涓嶇敓鎴愮┖鐩樺嚭搴撲换鍔�
-        StaProtocol staProtocol = devpThread.getStation().get(autoOutSite);
-        if (staProtocol == null) {
-            return;
-        } else {
-            staProtocol = staProtocol.clone();
-        }
-        if (staProtocol.isAutoing()  //鑷姩
-                && !staProtocol.isLoading()  //鏃犵墿
-                && staProtocol.isOutEnable()  //鍙嚭淇″彿
-                && staProtocol.getWorkNo() == 0
-        ) {
-            WrkMast pakoutEmpty = wrkMastMapper.selectPakoutEmpty(autoOutSite);
-            if (null != pakoutEmpty) {
-                return;
-            }
-            try {
-                String response = new HttpHandler.Builder()
-                        .setUri(wmsUrl)
-                        .setPath("/rpc/auto/emptyOut/v1")
-                        .build()
-                        .doPost();
-                JSONObject jsonObject = JSON.parseObject(response);
-                if (jsonObject.getInteger("code").equals(200)) {
-                    JSONObject data = (JSONObject) jsonObject.get("data");
-                    log.info((String) data.get("msg"));
-                } else {
-                    log.error("璇锋眰鎺ュ彛澶辫触锛侊紒锛乽rl锛歿}锛況equest锛歿}锛況esponse锛歿}", wmsUrl + "/rpc/auto/emptyOut/v1","", response);
-                }
-            } catch (Exception e) {
-                e.printStackTrace();
-                TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
-            }
-        }
-    }
-
-    public synchronized void autoEmptyIn() {
-        DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, 1);
-        Integer autoInSite = 12;
-        StaProtocol staProtocol = devpThread.getStation().get(autoInSite);
-        if (staProtocol == null) {
-            return;
-        } else {
-            staProtocol = staProtocol.clone();
-        }
-        if (staProtocol.isAutoing()  //鑷姩
-                && staProtocol.isLoading()  //鏈夌墿
-                && staProtocol.isInEnable()  //鍙叆淇″彿
-                && (staProtocol.getWorkNo() == 0 || staProtocol.getWorkNo() > 9990) //宸ヤ綔鍙蜂负0鎴栬�呭伐浣滃彿鏄�9991~9999锛堣緭閫佹満鐣欑敤锛�
-        ) {
-
-            try {
-                LocTypeDto locTypeDto = new LocTypeDto((short) 1, (short) 1, (short) 1);
-
-
-                String response = new HttpHandler.Builder()
-                        .setUri(wmsUrl)
-                        .setPath("/rpc/auto/emptyIn/v1")
-                        .setJson(JSON.toJSONString(locTypeDto))
-                        .build()
-                        .doPost();
-                JSONObject jsonObject = JSON.parseObject(response);
-                if (jsonObject.getInteger("code").equals(200)) {
-                    log.info((String) jsonObject.get("msg"));
-                } else {
-                    log.error("璇锋眰鎺ュ彛澶辫触锛侊紒锛乽rl锛歿}锛況equest锛歿}锛況esponse锛歿}", wmsUrl + "/rpc/auto/emptyIn/v1", JSON.toJSONString(locTypeDto), response);
-                }
-            } catch (Exception e) {
-                e.printStackTrace();
-                TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
-            }
-        }
-    }
-
 //    /**
 //     * 鍏朵粬  ===>> 鐮佸灈浣嶈嚜鍔ㄨˉ鍏呯┖鏉匡細椹卞姩鎷嗙洏鏈鸿緭鍑烘墭鐩�
 //     */
@@ -3971,10 +3193,10 @@
      */
     public synchronized void stackingCompletionDriveTray() {
         try {
-            int[] staNos=new int[]{216,220,123};//(3涓叆搴撶珯鐐癸紝1妤�1涓��璐х爜鍨涚珯锛�2妤间袱涓叆搴撶爜鍨涚珯)
+            int[] staNos=new int[]{215,219};//(2妤间袱涓叆搴撶爜鍨涚珯)
             for (int staNo : staNos){
                 BasDevp basDevp = basDevpService.selectById(staNo);
-                if (basDevp.getWrkNo()!=9992 || Cools.isEmpty(basDevp.getBarcode())){
+                if ((basDevp.getWrkNo()!=0 && (basDevp.getWrkNo()<9900 || basDevp.getWrkNo()>9999)) || Cools.isEmpty(basDevp.getBarcode())){
                     continue;
                 }
                 Integer zpallet = waitPakinMapper.selectCount(new EntityWrapper<WaitPakin>().eq("zpallet", basDevp.getBarcode()).eq("status","N"));
@@ -4005,11 +3227,11 @@
                         && staProtocol.isLoading()
                         && staProtocol.isInEnable()
                         && !staProtocol.isEmptyMk()
-                        && staProtocol.getWorkNo() == 9992
+                        && (basDevp.getWrkNo()==0 || (basDevp.getWrkNo()>=9900 && basDevp.getWrkNo()<=9999))
                 ) {//&& staProtocol.isPakMk() && !Cools.isEmpty(barcode)) {
-
-                    staProtocol.setWorkNo(9999);
-                    staProtocol.setStaNo(staNo + 1);
+                    int workNo = commonService.getWorkNo(5);
+                    staProtocol.setWorkNo(workNo);
+                    staProtocol.setStaNo(staNo + 2);
                     devpThread.setPakMk(staProtocol.getSiteId(), false);
                     boolean result = MessageQueue.offer(SlaveType.Devp, devpThread.getSlave().getId(), new Task(2, staProtocol));
                     if (!result) {
@@ -4120,7 +3342,7 @@
                         // 鏃犳嫞鏂欐暟鎹�
                         continue;
                     }
-                    if (!wrkMast.getSheetNo().equals("2") || wrkMast.getIoType()<100 || wrkMast.getWrkSts()!=14){
+                    if (Cools.isEmpty(wrkMast.getSheetNo()) || !wrkMast.getSheetNo().equals("2") || wrkMast.getIoType()<100 || wrkMast.getWrkSts()!=14){
                         continue;
                     }
                     if (wrkMast.getIoType()==101){
@@ -4213,6 +3435,76 @@
     }
 
     /**
+     * 鍏朵粬  ===>> 閫�璐х爜鍨涘畬鎴愭墭鐩樼户缁笅涓�姝�
+     */
+    public synchronized void stackingCompletionDriveTrayOk3() {
+        try {
+            int[] staNos=new int[]{118};
+            for (int staNo : staNos){
+                BasDevp basDevp = basDevpService.selectById(staNo);
+                if (Cools.isEmpty(basDevp) || basDevp.getWrkNo()!=0 || basDevp.getReportSign()!=3){
+                    continue;
+                }
+                WrkMast wrkMast = wrkMastMapper.selectWrkMastUnstackingOne145(145);
+                if (Cools.isEmpty(wrkMast)){
+                    continue;
+                }
+                // 鑾峰彇绔欑偣淇℃伅
+                SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, 1);
+                StaProtocol staProtocol = devpThread.getStation().get(staNo);
+                if (staProtocol == null) {
+                    continue;
+                } else {
+                    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;
+                }
+                // 鍒ゆ柇鏄惁婊¤冻鍏ュ簱鏉′欢
+                if (staProtocol.isAutoing()
+                        && 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);
+                    boolean result = MessageQueue.offer(SlaveType.Devp, devpThread.getSlave().getId(), new Task(2, staProtocol));
+                    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){
+//            e.printStackTrace();
+//            TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
+            log.error("鍏朵粬  ===>> 閫�璐х爜鍨涘畬鎴愭墭鐩樼户缁笅涓�姝�"+e);
+        }
+    }
+
+    /**
      * 鍏朵粬  ===>> 鎷嗗灈瀹屾垚缁х画涓嬩竴姝�  杩愯閫斾腑鑷姩閬胯绌烘澘
      */
     public synchronized void stackingCompletionDriveTray4() {
@@ -4261,9 +3553,9 @@
                         && staProtocol.isLoading()
                         && basDevp.getReportSign()==0
                 ) {//&& staProtocol.isPakMk() && !Cools.isEmpty(barcode)) {
-                    if (true){
-                        return;
-                    }
+//                    if (true){
+//                        return;
+//                    }
 
                     //浠诲姟瀹屾垚
                     boolean result1 = MessageQueue.offer(SlaveType.Devp, devpThread.getSlave().getId(), new Task(3, staProtocol135));
@@ -4272,7 +3564,8 @@
                     }catch (Exception e){ }
                     basDevp135.setReportSign(2);
                     basDevpService.updateById(basDevp135);
-                    staProtocol135.setWorkNo(32222);
+                    int workNo = commonService.getWorkNo(5);
+                    staProtocol135.setWorkNo(workNo);
                     staProtocol135.setStaNo(144);
                     devpThread.setPakMk(staProtocol135.getSiteId(), false);
                     boolean result = MessageQueue.offer(SlaveType.Devp, devpThread.getSlave().getId(), new Task(2, staProtocol135));
@@ -4330,22 +3623,47 @@
                             log.error("鏈煡鍒板皬杞︽墽琛屼换鍔℃垨鑰呮墽琛屼换鍔$姸鎬佷笉绗﹀悎锛�"+wrkMastSta);
                             continue;
                         }
-                        boolean rgvComplete = rgvComplete(rgvProtocol.getRgvNo());
-                        if (!rgvComplete){
-                            log.error("灏忚溅澶嶄綅澶辫触锛屽皬杞﹀彿{}锛�",rgvProtocol.getRgvNo());
-                            break;
-                        }
-
-                        DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, 1);
-                        StaProtocol staProtocol = devpThread.getStation().get(wrkMastSta.getStaEnd());
                         WrkMast wrkMast = wrkMastMapper.selectPakInStep3(wrkMastSta.getWrkNo().intValue());
-                        if (!Cools.isEmpty(wrkMast)){
+                        if (!Cools.isEmpty(wrkMast) && wrkMastSta.getWrkType()!=5){
+                            Thread.sleep(200);
+                            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;
+                            }
                             // 涓嬪彂绔欑偣淇℃伅
                             staProtocol.setWorkNo(wrkMast.getWrkNo());
                             staProtocol.setStaNo(wrkMast.getStaNo());
                             if (!MessageQueue.offer(SlaveType.Devp, 1, new Task(2, staProtocol))) {
                                 continue;
                             }
+                            log.error("灏忚溅浠诲姟瀹屾垚涓嬪彂杈撻�佺嚎浠诲姟锛�"+staProtocol);
+//                            try{
+//                                Thread.sleep(1000);
+//                                DevpThread devpThreadEnd = (DevpThread) SlaveConnection.get(SlaveType.Devp, 1);
+//                                StaProtocol staProtocolEnd = devpThreadEnd.getStation().get(wrkMastSta.getStaEnd());
+//                                log.error("灏忚溅浠诲姟瀹屾垚璇诲彇杈撻�佺嚎浠诲姟锛�"+staProtocolEnd);
+//                                if (staProtocolEnd.getWorkNo()==0 ){ //|| !staProtocolEnd.getWorkNo().equals(wrkMast.getWrkNo())
+//                                    staProtocolEnd.setWorkNo(wrkMast.getWrkNo());
+//                                    staProtocolEnd.setStaNo(wrkMast.getStaNo());
+//                                    if (!MessageQueue.offer(SlaveType.Devp, 1, new Task(2, staProtocolEnd))) {
+//                                        continue;
+//                                    }
+//                                    log.error("灏忚溅浠诲姟瀹屾垚涓嬪彂杈撻�佺嚎浠诲姟绗簩娆★細"+staProtocolEnd);
+//                                }
+//                            }catch (Exception e){
+//
+//                            }
+                        }
+                        boolean rgvComplete = rgvComplete(rgvProtocol.getRgvNo());
+                        if (!rgvComplete){
+                            log.error("灏忚溅澶嶄綅澶辫触锛屽皬杞﹀彿{}锛�",rgvProtocol.getRgvNo());
+                            break;
                         }
                         wrkMastSta.setWrkSts(3);
                         wrkMastStaMapper.updateById(wrkMastSta);
@@ -4368,21 +3686,42 @@
                             log.error("鏈煡鍒板皬杞︽墽琛屼换鍔℃垨鑰呮墽琛屼换鍔$姸鎬佷笉绗﹀悎锛�"+wrkMastSta);
                             continue;
                         }
-                        boolean rgvComplete = rgvComplete(rgvProtocol.getRgvNo());
-                        if (!rgvComplete){
-                            log.error("灏忚溅澶嶄綅澶辫触锛屽皬杞﹀彿{}锛�",rgvProtocol.getRgvNo());
-                            break;
-                        }
-                        DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, 1);
-                        StaProtocol staProtocol = devpThread.getStation().get(wrkMastSta.getStaEnd());
                         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());
+                            if (!staProtocol.isAutoing() || !staProtocol.isLoading()){
+                                continue;
+                            }
                             // 涓嬪彂绔欑偣淇℃伅
                             staProtocol.setWorkNo(wrkMast.getWrkNo());
                             staProtocol.setStaNo(wrkMast.getStaNo());
                             if (!MessageQueue.offer(SlaveType.Devp, 1, new Task(2, staProtocol))) {
                                 continue;
                             }
+                            log.error("灏忚溅浠诲姟瀹屾垚涓嬪彂杈撻�佺嚎浠诲姟锛�"+staProtocol);
+//                            try{
+//                                Thread.sleep(1000);
+//                                DevpThread devpThreadEnd = (DevpThread) SlaveConnection.get(SlaveType.Devp, 1);
+//                                StaProtocol staProtocolEnd = devpThreadEnd.getStation().get(wrkMastSta.getStaEnd());
+//                                log.error("灏忚溅浠诲姟瀹屾垚璇诲彇杈撻�佺嚎浠诲姟锛�"+staProtocolEnd);
+//                                if (staProtocolEnd.getWorkNo()==0 ){ //|| !staProtocolEnd.getWorkNo().equals(wrkMast.getWrkNo())
+//                                    staProtocolEnd.setWorkNo(wrkMast.getWrkNo());
+//                                    staProtocolEnd.setStaNo(wrkMast.getStaNo());
+//                                    if (!MessageQueue.offer(SlaveType.Devp, 1, new Task(2, staProtocolEnd))) {
+//                                        continue;
+//                                    }
+//                                    log.error("灏忚溅浠诲姟瀹屾垚涓嬪彂杈撻�佺嚎浠诲姟绗簩娆★細"+staProtocolEnd);
+//                                }
+//                            }catch (Exception e){
+//
+//                            }
+                        }
+                        boolean rgvComplete = rgvComplete(rgvProtocol.getRgvNo());
+                        if (!rgvComplete){
+                            log.error("灏忚溅澶嶄綅澶辫触锛屽皬杞﹀彿{}锛�",rgvProtocol.getRgvNo());
+                            break;
                         }
                         wrkMastSta.setWrkSts(3);
                         wrkMastStaMapper.updateById(wrkMastSta);
@@ -4399,11 +3738,14 @@
         }
     }
     /**
-     * 鎵ц灏忚溅鎼繍浠诲姟
+     * 鍏ュ嚭搴�  ===>>  灏忚溅浣滀笟涓嬪彂
      */
-    public synchronized void rgvRunWrkMastFullSta() {
+    public synchronized boolean rgvIoExecute(Integer sign) {
+        boolean rgvIoExecuteSign = false;
         try{
             for (RgvSlave rgvSlave:slaveProperties.getRgv()) {
+                // 鑾峰彇灏忚溅淇℃伅
+                boolean signWork = false;
                 RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgvSlave.getId());
                 RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
                 if (rgvProtocol == null) {
@@ -4417,6 +3759,98 @@
 
                 // 鍙湁褰揜GV绌洪棽銆佽嚜鍔�,宸ヤ綅涓�鏃犵墿//rgv鍙敤
                 if (rgvProtocol.getStatusType() == RgvStatusType.IDLE
+                        && rgvProtocol.getStatusType1() == RgvStatusType.IDLE
+                        && rgvProtocol.getStatusType2() == RgvStatusType.IDLE
+                        && rgvProtocol.getModeType() == RgvModeType.AUTO
+                        && rgvProtocol.getLoaded1()==0
+                        && rgvProtocol.getTaskNo1()==0 && rgvProtocol.getTaskNo2()==0
+                ) {
+                    switch (sign){
+                        //鎵ц灏忚溅璐х墿鎼繍浠诲姟
+                        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 = qwe();
+                            break;
+                        default:
+                            break;
+                    }
+                    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;
+                        }
+                    }
+                }else {
+                    continue;
+                }
+                if (!rgvIoExecuteSign){
+                    rgvIoExecuteSign = signWork;
+                }
+            }
+//            if (!rgvIoExecuteSign){
+//                if (sign>6){
+//
+//                }
+//            }
+        }catch (Exception e){
+            log.error("RGV灏忚溅浠诲姟涓嬪彂鎶ラ敊"+e);
+        }
+        return rgvIoExecuteSign;
+    }
+    /**
+     * 鎵ц灏忚溅鎼繍浠诲姟
+     */
+    public synchronized boolean rgvRunWrkMastFullSta(RgvSlave rgvSlave) {
+        try{
+//            for (RgvSlave rgvSlave:slaveProperties.getRgv()) {
+                RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgvSlave.getId());
+                RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
+                if (rgvProtocol == null) {
+                    return false;
+                }
+                BasRgv basRgv = basRgvService.selectById(rgvSlave.getId());
+                if (basRgv == null) {
+                    log.error("{}鍙稲GV灏氭湭鍦ㄦ暟鎹簱杩涜缁存姢锛�", rgvSlave.getId());
+                    return false;
+                }
+
+                // 鍙湁褰揜GV绌洪棽銆佽嚜鍔�,宸ヤ綅涓�鏃犵墿//rgv鍙敤
+                if (rgvProtocol.getStatusType() == RgvStatusType.IDLE
+                        && rgvProtocol.getStatusType1() == RgvStatusType.IDLE
+                        && rgvProtocol.getStatusType2() == RgvStatusType.IDLE
                         && rgvProtocol.getModeType() == RgvModeType.AUTO
                         && rgvProtocol.getLoaded1()==0
                         && rgvProtocol.getTaskNo1()==0 && rgvProtocol.getTaskNo2()==0
@@ -4424,18 +3858,46 @@
                     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());
+                    List<Integer> routeNear = RouteUtils.getRoute(basRgvMap.getStartRouteOther(), basRgvMap.getEndRouteOther());
                     basRgvMap.setNowRoute(rgvProtocol.getRgvPosI()); //鏇存柊灏忚溅褰撳墠浣嶇疆绔欑偣鍙�
+                    if (rgvProtocol.getRgvNo()==1){//鍒囨崲杩戣寖鍥�
+                        route = routeNear;
+                    }
                     List<WrkMastSta> wrkMastStaList = wrkMastStaMapper.selectNoInterfereList(route, route);
                     for (WrkMastSta wrkMastSta : wrkMastStaList){
                         if (wrkMastSta.getType()!=1 || wrkMastSta.getWrkType()!=3){//1:婊$増   3锛氬彇鏀�
                             continue;
                         }
+                        BasDevp basDevp = basDevpService.selectById(wrkMastSta.getStaEnd());
+                        if (!basDevp.getAutoing().equals("Y") || basDevp.getLoading().equals("Y") || basDevp.getWrkNo()!=0){
+                            continue;
+                        }
+                        List<Integer> STA_WORK_CU1 = new ArrayList<Integer>() {{
+                            add(101);add(102);add(104);add(105);add(107);add(108);add(118);add(119);add(122);
+                        }};
+                        List<Integer> STA_WORK_CU2 = new ArrayList<Integer>() {{
+                            add(110);add(111);add(113);add(114);add(116);add(117);add(120);add(121);add(122);add(123);
+                        }};
+                        if (basRgv.getRgvNo()==1 && !STA_WORK_CU1.contains(wrkMastSta.getStaStart())){
+                            continue;
+                        }else if (basRgv.getRgvNo()==2 && !STA_WORK_CU2.contains(wrkMastSta.getStaStart())){
+                            continue;
+                        }
+
+                        if (basDevp.getDevNo()>=118 && basDevp.getDevNo()<=123){
+                            if (!basDevp.getEmptyMk().equals("Y")){
+                                continue;
+                            }
+                        }
+                        Date date = new Date();
+                        log.info(date+"鍙栨斁浠诲姟涓嬪彂锛氬皬杞﹀伐浣滄。锛�"+wrkMastSta);
+                        log.info(date+"鍙栨斁浠诲姟涓嬪彂锛氱洰鏍囩珯鐘舵�侊細"+basDevp);
                         boolean sign = rgvTakeFullAll(basRgvMap.getRgvNo(), wrkMastSta);
                         if (sign){
-                            boolean signMap = rgvMapUpdate(basRgvMap, wrkMastSta.getStaStart(), wrkMastSta.getStaEnd());
+                            boolean signMap = rgvMapUpdate(basRgvMap, wrkMastSta.getStaStart(), wrkMastSta.getStaEnd(),rgvProtocol.getRgvNo()==1);
                             if (signMap){
                                 wrkMastSta.setWrkSts(1);
                                 try{
@@ -4443,7 +3905,7 @@
                                 }catch (Exception e){
                                     log.error("鏇存柊灏忚溅浠诲姟澶辫触");
                                 }
-                                return;
+                                return true;
                             }else {
                                 log.error("3864琛岋紝璐х墿鎼繍浠诲姟锛氬伐浣滃彿{}鎵�灞炰换鍔′笅鍙戝悗鍦板浘鍚屾澶辫触",wrkMastSta.getWrkNo());
                             }
@@ -4453,42 +3915,49 @@
                         break;
                     }
                 }
-            }
+//            }
         }catch (Exception e){
             log.error("3875琛屾墽琛屽皬杞︽惉杩愪换鍔′笅鍙戝け璐�");
             log.error("3875琛�"+e);
         }
+        return false;
     }
     /**
      * 鎵ц灏忚溅鎼繍浠诲姟//鎷嗙洏
      */
-    public synchronized void 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鍙敤//鎷嗙洏
                 if (rgvProtocol.getStatusType() == RgvStatusType.IDLE
+                        && rgvProtocol.getStatusType1() == RgvStatusType.IDLE
+                        && rgvProtocol.getStatusType2() == RgvStatusType.IDLE
                         && rgvProtocol.getModeType() == RgvModeType.AUTO
                         && rgvProtocol.getTaskNo1()==0 && rgvProtocol.getTaskNo2()==0
-                        && (rgvProtocol.getLoaded2()==3  || rgvProtocol.getLoaded2()==1 )////0 鏃犵墿锛�1 涓�灞傛棤鐗╀簩灞傛湁鐗� 锛堝彧鑳芥媶鍙狅級 锛�2涓�灞傛湁鐗╀簩灞傛棤鐗� 锛�3  1銆�2灞傞兘鏈夌墿
+                        && (rgvProtocol.getLoaded2()==3  || rgvProtocol.getLoaded2()==1 || rgvProtocol.getLoaded2()==4)////0 鏃犵墿锛�1 涓�灞傛棤鐗╀簩灞傛湁鐗� 锛堝彧鑳芥媶鍙狅級 锛�2涓�灞傛湁鐗╀簩灞傛棤鐗�() 锛�3  1銆�2灞傞兘鏈夌墿  4锛氾紙锛夊彧鍏佽鎷嗙洏
                 ) {
                     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());//鑾峰彇娲诲姩鑼冨洿
+                    List<Integer> routeNear = RouteUtils.getRoute(basRgvMap.getStartRouteOther(), basRgvMap.getEndRouteOther());
+                    if (rgvProtocol.getRgvNo()==2){//鍒囨崲杩戣寖鍥�
+                        route = routeNear;
+                    }
                     List<WrkMastSta> wrkMastStaList = wrkMastStaMapper.selectNoInterfereList(route, route);//鏌ヨ鍙墽琛屼换鍔�
                     for (WrkMastSta wrkMastSta : wrkMastStaList){
                         if (wrkMastSta.getType()!=2 || wrkMastSta.getWrkType()!=2){// 2:绌烘澘  || 宸ヤ綔绫诲瀷  1:鍙栵紙鍙犵洏锛�  2锛氭媶鐩�  5锛氭弧鍙�  6锛氭弧鏀�
@@ -4496,12 +3965,24 @@
                         }
                         boolean sign = false;
                         if ( wrkMastSta.getStaEnd()!=0){//鏀�
+                            BasDevp basDevp = basDevpService.selectById(wrkMastSta.getStaEnd());
+                            if (!basDevp.getAutoing().equals("Y") || basDevp.getLoading().equals("Y") || basDevp.getWrkNo()!=0){
+                                continue;
+                            }
+                            if (basDevp.getDevNo()>=118 && basDevp.getDevNo()<=123){
+                                if (!basDevp.getEmptyMk().equals("Y")){
+                                    continue;
+                                }
+                            }
+                            Date date = new Date();
+                            log.info(date+"鎷嗙洏浠诲姟涓嬪彂锛氬皬杞﹀伐浣滄。锛�"+wrkMastSta);
+                            log.info(date+"鎷嗙洏浠诲姟涓嬪彂锛氱洰鏍囩珯鐘舵�侊細"+basDevp);
                             sign = rgvPutEmpty(rgvProtocol.getRgvNo(),wrkMastSta);//鎷嗙洏
                         }else {
                             continue;
                         }
                         if (sign){
-                            boolean signMap = rgvMapUpdate(basRgvMap, basRgvMap.getStartRoute(), wrkMastSta.getStaEnd());
+                            boolean signMap = rgvMapUpdate(basRgvMap, basRgvMap.getStartRoute(), wrkMastSta.getStaEnd(),rgvProtocol.getRgvNo()==2);
                             if (signMap){
                                 wrkMastSta.setWrkSts(2);
                                 try{
@@ -4509,7 +3990,7 @@
                                 }catch (Exception e){
                                     log.error("鏇存柊灏忚溅浠诲姟澶辫触");
                                 }
-                                return;
+                                return true;
                             }else {
                                 log.error("3857琛岋紝璐х墿鎼繍浠诲姟锛氬伐浣滃彿{}鎵�灞炰换鍔′笅鍙戝悗鍦板浘鍚屾澶辫触",wrkMastSta.getWrkNo());
                             }
@@ -4519,55 +4000,75 @@
                         break;
                     }
                 }
-            }
+//            }
         }catch (Exception e){
             log.error("3933琛屾墽琛屽皬杞︽斁绌烘澘浠诲姟涓嬪彂澶辫触");
             log.error("3933琛�"+e);
         }
+        return false;
     }
 
     /**
      * 鎵ц灏忚溅鎼繍浠诲姟
      */
-    public synchronized void 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鍙敤
                 if (rgvProtocol.getStatusType() == RgvStatusType.IDLE
+                        && rgvProtocol.getStatusType1() == RgvStatusType.IDLE
+                        && rgvProtocol.getStatusType2() == RgvStatusType.IDLE
                         && rgvProtocol.getModeType() == RgvModeType.AUTO
-                        &&  (rgvProtocol.getLoaded2()==2  || rgvProtocol.getLoaded2()==3 ) ////0 鏃犵墿锛�1 涓�灞傛棤鐗╀簩灞傛湁鐗�  锛�2涓�灞傛湁鐗╀簩灞傛棤鐗� 锛堝彧鑳芥弧鏀撅級锛�3  1銆�2灞傞兘鏈夌墿
+                        && rgvProtocol.getTaskNo1()==0 && rgvProtocol.getTaskNo2()==0
+                        &&  (rgvProtocol.getLoaded2()==2  || rgvProtocol.getLoaded2()==3 ) ////0 鏃犵墿锛�1 涓�灞傛棤鐗╀簩灞傛湁鐗�  锛�2涓�灞傛湁鐗╀簩灞傛棤鐗� 锛堝彧鑳芥弧鏀撅級锛�3  1銆�2灞傞兘鏈夌墿  4锛氾紙锛夊彧鍏佽鎷嗙洏
                 ) {
                     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());//鑾峰彇娲诲姩鑼冨洿
+                    List<Integer> routeNear = RouteUtils.getRoute(basRgvMap.getStartRouteOther(), basRgvMap.getEndRouteOther());
+                    if (rgvProtocol.getRgvNo()==2){//鍒囨崲杩戣寖鍥�
+                        route = routeNear;
+                    }
                     List<WrkMastSta> wrkMastStaList = wrkMastStaMapper.selectNoInterfereList(route, route);//鏌ヨ鍙墽琛屼换鍔�
                     for (WrkMastSta wrkMastSta : wrkMastStaList){
-                        if (wrkMastSta.getType()!=2 || wrkMastSta.getWrkType()!=6){// 2:绌烘澘  || 宸ヤ綔绫诲瀷  1:鍙栵紙鍙犵洏锛�  2锛氭媶鐩�  5锛氭弧鍙�  6锛氭弧鏀�
+                        if (wrkMastSta.getType()!=2 || wrkMastSta.getWrkType()!=6){// 2:绌烘澘  || 宸ヤ綔绫诲瀷  1:鍙栵紙鍙犵洏锛�  2锛氭媶鐩�  5锛氭弧鍙�  6锛氭弧鏀�  7:鎻愬崌
                             continue;
                         }
                         boolean sign = false;
                         if ( wrkMastSta.getStaEnd()!=0){//婊℃斁
+                            BasDevp basDevp = basDevpService.selectById(wrkMastSta.getStaEnd());
+                            if (!basDevp.getAutoing().equals("Y") || basDevp.getLoading().equals("Y") || basDevp.getWrkNo()!=0){
+                                continue;
+                            }
+                            if (basDevp.getDevNo()>=118 && basDevp.getDevNo()<=123){
+                                if (!basDevp.getEmptyMk().equals("Y")){
+                                    continue;
+                                }
+                            }
+                            Date date = new Date();
+                            log.info(date+"婊℃斁浠诲姟涓嬪彂锛氬皬杞﹀伐浣滄。锛�"+wrkMastSta);
+                            log.info(date+"婊℃斁浠诲姟涓嬪彂锛氱洰鏍囩珯鐘舵�侊細"+basDevp);
                             sign = rgvPutEmptyFull(rgvProtocol.getRgvNo(),wrkMastSta);
                         }else {
                             continue;
                         }
                         if (sign){
-                            boolean signMap = rgvMapUpdate(basRgvMap, basRgvMap.getStartRoute(), wrkMastSta.getStaEnd());
+                            boolean signMap = rgvMapUpdate(basRgvMap, basRgvMap.getStartRoute(), wrkMastSta.getStaEnd(),rgvProtocol.getRgvNo()==2);
                             if (signMap){
                                 wrkMastSta.setWrkSts(2);
                                 try{
@@ -4575,7 +4076,7 @@
                                 }catch (Exception e){
                                     log.error("鏇存柊灏忚溅浠诲姟澶辫触");
                                 }
-                                return;
+                                return true;
                             }else {
                                 log.error("3857琛岋紝璐х墿鎼繍浠诲姟锛氬伐浣滃彿{}鎵�灞炰换鍔′笅鍙戝悗鍦板浘鍚屾澶辫触",wrkMastSta.getWrkNo());
                             }
@@ -4585,39 +4086,46 @@
                         break;
                     }
                 }
-            }
+//            }
         }catch (Exception e){
             log.error("3933琛屾墽琛屽皬杞︽斁绌烘澘浠诲姟涓嬪彂澶辫触");
             log.error("3933琛�"+e);
         }
+        return false;
     }
 
-    public synchronized void 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鍙敤
                 if (rgvProtocol.getStatusType() == RgvStatusType.IDLE
+                        && rgvProtocol.getStatusType1() == RgvStatusType.IDLE
+                        && rgvProtocol.getStatusType2() == RgvStatusType.IDLE
                         && rgvProtocol.getModeType() == RgvModeType.AUTO
                         && rgvProtocol.getTaskNo1()==0 && rgvProtocol.getTaskNo2()==0
-                        &&  (rgvProtocol.getLoaded2()==0  || rgvProtocol.getLoaded2()==1 ) //鐜板満淇敼锛氬彔鐩樻満锛�////0 鏃犵墿锛�1 涓�灞傛棤鐗╀簩灞傛湁鐗╋紙鍙兘鎷嗗彔锛�   锛�2涓�灞傛湁鐗╀簩灞傛棤鐗� 锛堝彧鑳芥弧鏀撅級锛�3  1銆�2灞傞兘鏈夌墿
+                        &&  (rgvProtocol.getLoaded2()==0  || rgvProtocol.getLoaded2()==1 ) //鐜板満淇敼锛氬彔鐩樻満锛�////0 鏃犵墿锛�1 涓�灞傛棤鐗╀簩灞傛湁鐗╋紙鍙兘鎷嗗彔锛�   锛�2涓�灞傛湁鐗╀簩灞傛棤鐗� 锛堝彧鑳芥弧鏀撅級锛�3  1銆�2灞傞兘鏈夌墿  4锛氾紙锛夊彧鍏佽鎷嗙洏
                 ) {
                     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());
+                    List<Integer> routeNear = RouteUtils.getRoute(basRgvMap.getStartRouteOther(), basRgvMap.getEndRouteOther());
+                    if (rgvProtocol.getRgvNo()==2){//鍒囨崲杩戣寖鍥�
+                        route = routeNear;
+                    }
                     basRgvMap.setNowRoute(rgvProtocol.getRgvPosI()); //鏇存柊灏忚溅褰撳墠浣嶇疆绔欑偣鍙�
                     List<WrkMastSta> wrkMastStaList = wrkMastStaMapper.selectNoInterfereList(route, route);
                     for (WrkMastSta wrkMastSta : wrkMastStaList){
@@ -4626,12 +4134,35 @@
                         }
                         boolean sign = false;
                         if ( wrkMastSta.getStaStart()!=0){//鍙�
+                            BasDevp basDevp = basDevpService.selectById(wrkMastSta.getStaStart());
+                            if (!basDevp.getAutoing().equals("Y") || !basDevp.getLoading().equals("Y")){
+                                continue;
+                            }
+                            List<Integer> STA_WORK_CU1 = new ArrayList<Integer>() {{
+                                add(101);add(102);add(104);add(105);add(107);add(108);add(118);add(119);add(122);
+                            }};
+                            List<Integer> STA_WORK_CU2 = new ArrayList<Integer>() {{
+                                add(110);add(111);add(113);add(114);add(116);add(117);add(120);add(121);add(122);add(123);
+                            }};
+                            if (basRgv.getRgvNo()==1 && !STA_WORK_CU1.contains(wrkMastSta.getStaStart())){
+                                continue;
+                            }else if (basRgv.getRgvNo()==2 && !STA_WORK_CU2.contains(wrkMastSta.getStaStart())){
+                                continue;
+                            }
+                            if (basDevp.getDevNo()>=118 && basDevp.getDevNo()<=123){
+                                if (!basDevp.getEmptyMk().equals("Y")){
+                                    continue;
+                                }
+                            }
+                            Date date = new Date();
+                            log.info(date+"鍙犵洏浠诲姟涓嬪彂锛氬皬杞﹀伐浣滄。锛�"+wrkMastSta);
+                            log.info(date+"鍙犵洏浠诲姟涓嬪彂锛氱洰鏍囩珯鐘舵�侊細"+basDevp);
                             sign = rgvTakeEmpty(rgvProtocol.getRgvNo(),wrkMastSta);//鍙犵洏
                         }else {
                             continue;
                         }
                         if (sign){
-                            boolean signMap = rgvMapUpdate(basRgvMap, wrkMastSta.getStaStart(), basRgvMap.getStartRoute());
+                            boolean signMap = rgvMapUpdate(basRgvMap, wrkMastSta.getStaStart(), basRgvMap.getStartRoute(),rgvProtocol.getRgvNo()==2);
                             if (signMap){
                                 wrkMastSta.setWrkSts(1);
                                 try{
@@ -4639,7 +4170,7 @@
                                 }catch (Exception e){
                                     log.error("鏇存柊灏忚溅浠诲姟澶辫触");
                                 }
-                                return;
+                                return true;
                             }else {
                                 log.error("3879琛岋紝璐х墿鎼繍浠诲姟锛氬伐浣滃彿{}鎵�灞炰换鍔′笅鍙戝悗鍦板浘鍚屾澶辫触",wrkMastSta.getWrkNo());
                             }
@@ -4649,52 +4180,74 @@
                         break;
                     }
                 }
-            }
+//            }
         }catch (Exception e){
             log.error("3989琛屾墽琛屽皬杞﹀彇绌烘澘浠诲姟涓嬪彂澶辫触");
             log.error("3989琛�"+e);
         }
+        return false;
     }
 
-    public synchronized void 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鍙敤
                 if (rgvProtocol.getStatusType() == RgvStatusType.IDLE
+                        && rgvProtocol.getStatusType1() == RgvStatusType.IDLE
+                        && rgvProtocol.getStatusType2() == RgvStatusType.IDLE
                         && rgvProtocol.getModeType() == RgvModeType.AUTO
-                        &&  rgvProtocol.getLoaded2()==0  //鐜板満淇敼锛氬彔鐩樻満锛�////0 鏃犵墿锛�1 涓�灞傛棤鐗╀簩灞傛湁鐗╋紙鍙兘鎷嗗彔锛�   锛�2涓�灞傛湁鐗╀簩灞傛棤鐗� 锛堝彧鑳芥弧鏀撅級锛�3  1銆�2灞傞兘鏈夌墿
+                        && rgvProtocol.getTaskNo1()==0 && rgvProtocol.getTaskNo2()==0
+                        &&  rgvProtocol.getLoaded2()==0  //鐜板満淇敼锛氬彔鐩樻満锛�////0 鏃犵墿锛�1 涓�灞傛棤鐗╀簩灞傛湁鐗╋紙鍙兘鎷嗗彔锛�   锛�2涓�灞傛湁鐗╀簩灞傛棤鐗� 锛堝彧鑳芥弧鏀撅級锛�3  1銆�2灞傞兘鏈夌墿  4锛氾紙锛夊彧鍏佽鎷嗙洏
                 ) {
                     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<Integer> routeNear = RouteUtils.getRoute(basRgvMap.getStartRouteOther(), basRgvMap.getEndRouteOther());
+                    if (rgvProtocol.getRgvNo()==2){//鍒囨崲杩戣寖鍥�
+                        route = routeNear;
+                    }
                     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;
                         }
                         boolean sign = false;
-                        if (wrkMastSta.getStaEnd()==0 && wrkMastSta.getStaStart()!=0){//婊″彇
+                        if (wrkMastSta.getStaStart()!=0){//婊″彇
+                            BasDevp basDevp = basDevpService.selectById(wrkMastSta.getStaStart());
+                            if (!basDevp.getAutoing().equals("Y") || !basDevp.getLoading().equals("Y")){
+                                continue;
+                            }
+                            Date date = new Date();
+                            log.info(date+"婊″彇浠诲姟涓嬪彂锛氬皬杞﹀伐浣滄。锛�"+wrkMastSta);
+                            log.info(date+"婊″彇浠诲姟涓嬪彂锛氱洰鏍囩珯鐘舵�侊細"+basDevp);
                             sign = rgvTakeEmptyFull(rgvProtocol.getRgvNo(),wrkMastSta);
                         }else {
                             continue;
                         }
                         if (sign){
-                            boolean signMap = rgvMapUpdate(basRgvMap, wrkMastSta.getStaStart(), basRgvMap.getStartRoute());
+                            boolean signMap = rgvMapUpdate(basRgvMap, wrkMastSta.getStaStart(), basRgvMap.getStartRoute(),rgvProtocol.getRgvNo()==2);
                             if (signMap){
                                 wrkMastSta.setWrkSts(1);
                                 try{
@@ -4702,7 +4255,7 @@
                                 }catch (Exception e){
                                     log.error("鏇存柊灏忚溅浠诲姟澶辫触");
                                 }
-                                return;
+                                return true;
                             }else {
                                 log.error("3879琛岋紝璐х墿鎼繍浠诲姟锛氬伐浣滃彿{}鎵�灞炰换鍔′笅鍙戝悗鍦板浘鍚屾澶辫触",wrkMastSta.getWrkNo());
                             }
@@ -4712,11 +4265,12 @@
                         break;
                     }
                 }
-            }
+//            }
         }catch (Exception e){
             log.error("3989琛屾墽琛屽皬杞﹀彇绌烘澘浠诲姟涓嬪彂澶辫触");
             log.error("3989琛�"+e);
         }
+        return false;
     }
 
     /*
@@ -4724,10 +4278,18 @@
     * */
     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;
             }
+            Integer[] rgvRunSta = RouteUtils.RgvRunSta(wrkMastSta.getStaStart(), wrkMastSta.getStaEnd());
+            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();
@@ -4746,18 +4308,51 @@
                         && rgvProtocol.getLoaded1()==0  //鐜板満淇敼锛氬彔鐩樻満锛屼笉婊¢兘绠楁棤鐗╋紝鎬庝箞鍒ゆ柇闇�瑕佽窡鐢垫帶瀵规帴
                         && rgvProtocol.getTaskNo1()==0
                         && rgvProtocol.getTaskNo2()==0
+                        && rgvProtocol.getStatusType1() == RgvStatusType.IDLE
+                        && rgvProtocol.getStatusType2() == RgvStatusType.IDLE
                 ) {
-                    BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
-                    if (rgvProtocol.getRgvPosI().equals(basRgvMap.getStartRoute())){
-                        continue;
+//                    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) )){
-                        continue;
+                        signRgv = false;
+                        break;
                     } else if (rgvProtocol.getRgvNo()==2 && (rgvProtocol.getRgvPosI().equals(116) || rgvProtocol.getRgvPosI().equals(117) ) ){
+                        signRgv = false;
+                        break;
+                    }
+                }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;
                     }
-                    rgvAvoidanceXY(rgvProtocol.getRgvNo());
-                    rgvMapUpdate(basRgvMap,basRgvMap.getStartRoute(),basRgvMap.getStartRoute());
+
+                    // 鍙湁褰揜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
+                    ) {
+                        BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
+                        rgvAvoidanceXY(rgvProtocol.getRgvNo(),rgvRunSta);
+                        rgvMapUpdate(basRgvMap,basRgvMap.getStartRoute(),basRgvMap.getStartRoute());
+                    }
                 }
             }
         }catch (Exception e){
@@ -4804,10 +4399,10 @@
     /*
      * 灏忚溅XY绉诲姩  閬胯
      * */
-    public synchronized boolean rgvAvoidanceXY(Integer rgvId){
-        if (rgvId==1){
+    public synchronized boolean rgvAvoidanceXY(Integer rgvId, Integer[] rgvRunSta){
+        if (rgvId==2){
             try{
-                BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvId);
+//                BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvId);
                 //  鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
                 RgvCommand rgvCommand = new RgvCommand();
                 rgvCommand.setRgvNo(rgvId); // RGV缂栧彿
@@ -4815,7 +4410,7 @@
                 rgvCommand.setTaskNo1((short)32222); // 宸ヤ綅1宸ヤ綔鍙�
                 rgvCommand.setTaskMode1(RgvTaskModeType.X_MOVE); // 宸ヤ綅1浠诲姟妯″紡:  鍥炲師鐐�
                 //basRgvMap.getLockStartRoute().shortValue()
-                rgvCommand.setSourceStaNo1( (short)101);
+                rgvCommand.setSourceStaNo1(rgvRunSta[1].shortValue());
                 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浠诲姟鍙�
@@ -4830,14 +4425,14 @@
             }
         }else {
             try{
-                BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvId);
+//                BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvId);
                 //  鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
                 RgvCommand rgvCommand = new RgvCommand();
                 rgvCommand.setRgvNo(rgvId); // RGV缂栧彿
                 rgvCommand.setAckFinish2((short) 0);  // 宸ヤ綅2浠诲姟瀹屾垚纭浣�
                 rgvCommand.setTaskNo2((short)32222); // 宸ヤ綅2宸ヤ綔鍙�
                 rgvCommand.setTaskMode2(RgvTaskModeType.X_MOVE); // 宸ヤ綅2浠诲姟妯″紡:  鍥炲師鐐�
-                rgvCommand.setSourceStaNo2((short)117);
+                rgvCommand.setSourceStaNo2(rgvRunSta[0].shortValue());
                 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浠诲姟鍙�
@@ -5053,6 +4648,13 @@
     /*
      * 灏忚溅鍦板浘鏇存柊  鏇存柊閿�
      * */
+    public synchronized boolean rgvMapUpdate(BasRgvMap basRgvMapCurrent,Integer staStart,Integer staEnd,boolean sign){
+        if (sign){
+            staStart = RouteUtils.RouteIndexFarMasOtherNearUpMap(basRgvMapCurrent.getRgvNo(),staStart);
+            staEnd = RouteUtils.RouteIndexFarMasOtherNearUpMap(basRgvMapCurrent.getRgvNo(),staEnd);
+        }
+        return rgvMapUpdate(basRgvMapCurrent,staStart,staEnd);
+    }
     public synchronized boolean rgvMapUpdate(BasRgvMap basRgvMapCurrent,Integer staStart,Integer staEnd){
 
 //        List<Integer> integers = RouteUtils.RouteMapCurrentFar(basRgvMapCurrent.getNowRoute(),staStart,staEnd, basRgvMapCurrent.getLockStartRoute());
@@ -5069,6 +4671,7 @@
             List<Integer> integers = RouteUtils.RouteMapCurrentFar(fallMerge, basRgvMapCurrent.getLockStartRoute());
             Integer lockEndRoute = RouteUtils.RouteMapOtherFarStnNo(integers, basRgvMapCurrent.getLockStartRoute());//鍙︿竴鍙板皬杞﹀彲娲诲姩鏈�杩滀綅缃�
             basRgvMapOther.setEndRoute(lockEndRoute);
+            basRgvMapOther.setEndRouteOther(RouteUtils.RouteIndexFarMasOtherNear(rgvNoOther,lockEndRoute));
             basRgvMapMapper.updateById(basRgvMapOther);
             return true;
         }catch (Exception e){
@@ -5077,4 +4680,79 @@
         }
     }
 
+    /**
+     * 浜屾ゼ绌烘墭鍥炴祦鍒颁竴妤硷紝3.绔欏埌绔欎换鍔�
+     */
+    public synchronized void emptyTrayReflux() {
+        for (CrnSlave crn : slaveProperties.getCrn()) {
+            List<WrkMast> wrkMastList = wrkMastMapper.selectList(new EntityWrapper<WrkMast>().eq("wrk_sts", 2)
+                    .eq("crn_no",crn.getId()).eq("io_type", 3));
+            for (WrkMast wrkMast : wrkMastList) {
+                CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn, crn.getId());
+                CrnProtocol crnProtocol = crnThread.getCrnProtocol();
+                if (crnProtocol == null) {
+                    continue;
+                }
+                if (crnProtocol.getStatusType() == CrnStatusType.IDLE
+                        && crnProtocol.getTaskNo() == 0
+                        && crnProtocol.getModeType() == CrnModeType.AUTO
+                        && crnProtocol.getLoaded() == 0
+                        && crnProtocol.getForkPos() == 0) {
+
+                    CrnSlave.CrnStn crnStn = null;
+                    CrnSlave.CrnStn crnStn2 = null;
+                    for (CrnSlave.CrnStn crnStn1 : crn.getCrnOutStn()){
+                        if(crnStn1.getStaNo().equals(wrkMast.getStaNo())){
+                            crnStn = crnStn1;
+                            break;
+                        }
+                    }
+                    for (CrnSlave.CrnStn crnStn1 : crn.getCrnInStn()){
+                        if(crnStn1.getStaNo().equals(wrkMast.getSourceStaNo())){
+                            crnStn2 = crnStn1;
+                            break;
+                        }
+                    }
+                    if(Cools.isEmpty(crnStn) || Cools.isEmpty(crnStn2)){
+                        continue;
+                    }
+
+                    // 鍏ュ簱鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
+                    CrnCommand crnCommand = new CrnCommand();
+                    crnCommand.setCrnNo(crnProtocol.getCrnNo()); // 鍫嗗灈鏈虹紪鍙�
+                    crnCommand.setTaskNo(wrkMast.getWrkNo().shortValue()); // 宸ヤ綔鍙�
+                    crnCommand.setAckFinish((short) 0);  // 浠诲姟瀹屾垚纭浣�
+                    crnCommand.setTaskMode(CrnTaskModeType.LOC_MOVE); // 浠诲姟妯″紡:  搴撲綅绉昏浆
+                    crnCommand.setSourcePosX(crnStn2.getRow().shortValue());     // 婧愬簱浣嶆帓
+                    crnCommand.setSourcePosY(crnStn2.getBay().shortValue());     // 婧愬簱浣嶅垪
+                    crnCommand.setSourcePosZ(crnStn2.getLev().shortValue());     // 婧愬簱浣嶅眰
+                    crnCommand.setDestinationPosX(crnStn.getRow().shortValue());     // 鐩爣搴撲綅鎺�
+                    crnCommand.setDestinationPosY(crnStn.getBay().shortValue());     // 鐩爣搴撲綅鍒�
+                    crnCommand.setDestinationPosZ(crnStn.getLev().shortValue());     // 鐩爣搴撲綅灞�
+//                    crnCommand.setSourceStaNo(crnStn.getPlatNo().shortValue());     // 婧愬簱浣嶆帓
+                    if (!MessageQueue.offer(SlaveType.Crn, wrkMast.getCrnNo(), new Task(2, crnCommand))) {
+                        log.error("鍫嗗灈鏈哄懡浠や笅鍙戝け璐ワ紝鍫嗗灈鏈哄彿={}锛屼换鍔℃暟鎹�={}", wrkMast.getCrnNo(), JSON.toJSON(crnCommand));
+                    } else {
+                        // 淇敼宸ヤ綔妗g姸鎬� 2.璁惧涓婅蛋 => 3.鍚婅溅鍏ュ簱涓�
+                        Date now = new Date();
+                        wrkMast.setWrkSts(3L);
+                        wrkMast.setCrnStrTime(now);
+                        wrkMast.setModiTime(now);
+                        if (wrkMastMapper.updateById(wrkMast) == 0) {
+                            log.error("淇敼宸ヤ綔妗g姸鎬� 2.璁惧涓婅蛋 => 3.鍚婅溅鍏ュ簱涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
+                        }
+                    }
+                    break;
+                }
+
+            }
+        }
+    }
+
+    /**
+     * 12.璺ㄥ贩閬撶Щ搴�
+     */
+    public synchronized void autoMoveLoc() {
+
+    }
 }

--
Gitblit v1.9.1