From 54c41bbbffd29c51762db3cc99e76f75617f2bda Mon Sep 17 00:00:00 2001
From: lty <876263681@qq.com>
Date: 星期一, 18 八月 2025 16:44:03 +0800
Subject: [PATCH] #

---
 src/main/java/com/zy/core/thread/RgvThread.java             |   26 +
 src/main/java/com/zy/asrs/entity/WrkMastSta.java            |   18 +
 src/main/java/com/zy/asrs/utils/RouteUtils.java             |   63 +++
 src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java |  820 +++++++++++++++++++++++++++++++++++++----------
 src/main/java/com/zy/core/MainProcess.java                  |    7 
 src/main/java/com/zy/core/model/protocol/RgvProtocol.java   |   19 
 src/main/java/com/zy/asrs/mapper/WrkMastStaMapper.java      |    5 
 src/main/resources/mapper/WrkMastStaMapper.xml              |   25 +
 8 files changed, 775 insertions(+), 208 deletions(-)

diff --git a/src/main/java/com/zy/asrs/entity/WrkMastSta.java b/src/main/java/com/zy/asrs/entity/WrkMastSta.java
index f3a2b96..1cf409a 100644
--- a/src/main/java/com/zy/asrs/entity/WrkMastSta.java
+++ b/src/main/java/com/zy/asrs/entity/WrkMastSta.java
@@ -119,9 +119,23 @@
     @DateTimeFormat(pattern="yyyy-MM-dd HH:mm:ss")
     private Date bignTime;
 
+    /**
+     * 宸ヤ綅鏍囪
+     */
+    @ApiModelProperty(value= "  1:宸ヤ綅1 2锛氬伐浣�2 ")
+    @TableField("work_sta")
+    private Integer workSta;
+
+    /**
+     * rgv鏍囪
+     */
+    @ApiModelProperty(value= "  rgv缂栧彿鏍囪 ")
+    @TableField("rgv_no")
+    private Integer rgvNo;
+
     public WrkMastSta() {}
 
-    public WrkMastSta(Long wrkNo, Integer wrkStart, Integer wrkEnd, Integer staStart, Integer staEnd, Date createTime, Date updateTime, Integer type, Integer wrkSts, Integer lineNumber, Integer wrkType, Date bignTime) {
+    public WrkMastSta(Long wrkNo, Integer wrkStart, Integer wrkEnd, Integer staStart, Integer staEnd, Date createTime, Date updateTime, Integer type, Integer wrkSts, Integer lineNumber, Integer wrkType, Date bignTime,Integer workSta, Integer rgvNo) {
         this.wrkNo = wrkNo;
         this.wrkStart = wrkStart;
         this.wrkEnd = wrkEnd;
@@ -134,6 +148,8 @@
         this.lineNumber = lineNumber;
         this.wrkType = wrkType;
         this.bignTime = bignTime;
+        this.workSta = workSta;
+        this.rgvNo = rgvNo;
     }
 
 //    WrkMastSta wrkMastSta = new WrkMastSta(
diff --git a/src/main/java/com/zy/asrs/mapper/WrkMastStaMapper.java b/src/main/java/com/zy/asrs/mapper/WrkMastStaMapper.java
index da34693..743cefb 100644
--- a/src/main/java/com/zy/asrs/mapper/WrkMastStaMapper.java
+++ b/src/main/java/com/zy/asrs/mapper/WrkMastStaMapper.java
@@ -31,7 +31,10 @@
     /*
     * 鏌ヨ涓嶅共娑夌殑鍙墽琛屼换鍔�
     * */
-    WrkMastSta selectNoInterfere(@Param("staStarts") List<Integer> staStarts, @Param("staEnds") List<Integer> staEnds);
+    WrkMastSta selectNoInterfere(@Param("staStarts") List<Integer> staStarts, @Param("staEnds") List<Integer> staEnds,@Param("workNo")Long workNo );
     List<WrkMastSta> selectNoInterfereList(@Param("staStarts") List<Integer> staStarts, @Param("staEnds") List<Integer> staEnds);
 
+
+    WrkMastSta selectByWorkSta(@Param("workSta") Integer workSta, @Param("rgv_no") Integer rgv_no);
+
 }
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 712baf2..d4e4613 100644
--- a/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java
+++ b/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java
@@ -2767,43 +2767,151 @@
         try{
             for (DevpSlave devp : slaveProperties.getDevp()) {
                 List<BasRgvMap> basRgvMaps = basRgvMapService.selectList(new EntityWrapper<>());
-            for (BasRgvMap rgvSlave:basRgvMaps) {
-                RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgvSlave.getRgvNo());
+            for (RgvSlave rgv : slaveProperties.getRgv()) {
+                RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgv.getId());
                 RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
                 if (rgvProtocol == null) {
                     continue;
                 }else {
                     rgvProtocol = rgvProtocol.clone();
                 }
-                BasRgv basRgv = basRgvService.selectById(rgvSlave.getRgvNo());
+                BasRgv basRgv = basRgvService.selectById(rgv.getId());
                 if (basRgv == null) {
-                    log.error("{}鍙稲GV灏氭湭鍦ㄦ暟鎹簱杩涜缁存姢锛�3", rgvSlave.getRgvNo());
+                    log.error("{}鍙稲GV灏氭湭鍦ㄦ暟鎹簱杩涜缁存姢锛�3", rgv.getId());
                     continue;
                 }
 
-                // 鍙湁褰揜GV绛夊緟WCS纭銆佽嚜鍔�
+                // 鍙湁褰揜GV宸ヤ綅1绛夊緟WCS纭銆佽嚜鍔�
                 if ((rgvProtocol.getStatusType1() == RgvStatusType.WAITING || rgvProtocol.getStatusType1()==RgvStatusType.FETCHWAITING)
                         && rgvProtocol.getModeType() == RgvModeType.AUTO
                         && (rgvProtocol.getStatusType() == RgvStatusType.WORKING1)
                 ){
                     log.info("{}鍙峰皬杞︾瓑寰厀cs纭锛岀姸鎬亄}锛屽弬鏁皗}",rgvProtocol.getRgvNo(),rgvProtocol.getStatusType(),rgvProtocol);
-                    if(rgvProtocol.getTaskNo1() == 9999){
-                        List<Integer> staNos = Arrays.asList( 1043, 1104);
-                        for (Integer staNo : staNos) {
-                            SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, devp.getId());
-                            StaProtocol staProtocol = devpThread.getStation().get(staNo);
-                            boolean rgvComplete = false;
-                            if(!staProtocol.isLoading()){
-                                rgvComplete = rgvComplete((int) rgvProtocol.getRgvNo(),3);//宸ヤ綅1澶嶄綅
+                    if(rgvProtocol.getTaskNo1() == 9999){ // 棰勮皟搴︿换鍔$‘璁�
+                        BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
+                        Integer staNo = basRgvMap.getNowRoute();
+                        switch (staNo){
+                            case 1004: staNo = 1042; break;
+                            case 1007: staNo = 1105; break;
+                        }
+
+                        SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, devp.getId());
+                        StaProtocol staProtocol = devpThread.getStation().get(staNo);
+                        boolean rgvComplete = false;
+
+                        long now = System.currentTimeMillis();
+                        if (staProtocol.isLoading()) {
+                            rgvProtocol.setLoadingStartTime(null); // 宸插埌浣嶏紝娓呯┖鏃堕棿鎴�
+                        } else {
+                            if (rgvProtocol.getLoadingStartTime() == null) {
+                                rgvProtocol.setLoadingStartTime(now);
                             }
+                        }
+
+                        if (staProtocol.isLoading() ||
+                                (rgvProtocol.getLoadingStartTime() != null && now - rgvProtocol.getLoadingStartTime() > 10000)) {
+                            rgvComplete = rgvComplete((int) rgvProtocol.getRgvNo(), 3);
                             if (!rgvComplete){
-                                log.error("灏忚溅澶嶄綅澶辫触锛屽皬杞﹀彿{}锛佺瓑寰呭叆搴撳彇璐�",rgvProtocol.getRgvNo());
-                                break;
+                                log.error("灏忚溅澶嶄綅澶辫触锛屽皬杞﹀彿{}锛佺瓑寰呭叆搴撳彇璐�", rgvProtocol.getRgvNo());
                             }
                         }
                     }
                     if (rgvProtocol.getTaskNo1()!=0 && rgvProtocol.getTaskNo1()!=9999){
                         WrkMastSta wrkMastSta = wrkMastStaMapper.selectByWrkNo(rgvProtocol.getTaskNo1());
+                        if(wrkMastSta.getWrkSts() == 1){//鍙栬揣纭
+                            wrkMastSta.setWrkSts(2);
+                            try{
+                                wrkMastStaMapper.updateById(wrkMastSta);
+                                log.error("鏇存柊灏忚溅浠诲姟鎴愬姛");
+                            }catch (Exception e){
+                                log.error("鏇存柊灏忚溅浠诲姟澶辫触");
+                            }
+                            boolean rgvComplete = false;
+
+                            rgvComplete = rgvComplete((int) rgvProtocol.getRgvNo(),7);
+                            if (!rgvComplete){
+                                log.error("灏忚溅澶嶄綅澶辫触锛屽皬杞﹀彿{}锛�",rgvProtocol.getRgvNo());
+                                break;
+                            }
+                            break;
+                        }
+                        if (Cools.isEmpty(wrkMastSta) || wrkMastSta.getWrkSts()!=1){
+                            log.error("鏈煡鍒板皬杞︽墽琛屼换鍔℃垨鑰呮墽琛屼换鍔$姸鎬佷笉绗﹀悎锛�"+wrkMastSta);
+                            continue;
+                        }
+
+                        SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, devp.getId());
+                        StaProtocol staProtocol = devpThread.getStation().get(wrkMastSta.getStaEnd());
+                        if (staProtocol == null) {
+                            continue;
+                        } else {
+                            staProtocol = staProtocol.clone();
+                        }
+                        if (!staProtocol.isAutoing() || !staProtocol.isLoading()){
+                            continue;
+                        }
+                        WrkMast wrkMast = wrkMastMapper.selectPakInStep3(wrkMastSta.getWrkNo().intValue());
+                        if (!Cools.isEmpty(wrkMast)){
+                            if (!staProtocol.isPakMk()){
+                                continue;
+                            }
+                            // 涓嬪彂绔欑偣淇℃伅
+                            staProtocol.setWorkNo(wrkMast.getWrkNo());
+                            staProtocol.setStaNo(wrkMast.getStaNo().shortValue());
+                            devpThread.setPakMk(staProtocol.getSiteId(), false);
+                            log.error("rgv浠诲姟瀹屾垚缁欒緭閫佺嚎涓嬪彂鍛戒护锛�"+wrkMast.getWrkNo()+","+wrkMast.getStaNo());
+                            if (!MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol))) {
+                                continue;
+                            }
+                        }
+                        boolean rgvComplete = false;
+
+                        rgvComplete = rgvComplete((int) rgvProtocol.getRgvNo(),3);
+                        if (!rgvComplete){
+                            log.error("灏忚溅澶嶄綅澶辫触锛屽皬杞﹀彿{}锛�",rgvProtocol.getRgvNo());
+                            break;
+                        }
+                        WrkMast wrkMast1 = wrkMastService.selectByWrkNo(rgvProtocol.getTaskNo1());
+                        wrkMast1.setPdcType("Y");
+
+                        wrkMastService.updateById(wrkMast1);
+
+                        wrkMastSta.setWrkSts(3);
+                        wrkMastStaMapper.updateById(wrkMastSta);
+                        BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
+                        basRgvMap.setNowRoute(rgvProtocol.getRgvPosI());
+                        rgvMapUpdate(basRgvMap,basRgvMap.getStartRoute(),basRgvMap.getStartRoute(),"2471");
+                    }
+
+                    else {
+                        log.error("灏忚溅澶嶄綅澶辫触锛屽皬杞﹀彿{},绛夊緟wcs纭浣嗘槸娌℃湁宸ヤ綔鍙凤紒",rgvProtocol.getRgvNo());
+                    }
+                }
+                // 鍙湁褰揜GV宸ヤ綅2绛夊緟WCS纭銆佽嚜鍔�
+                if ((rgvProtocol.getStatusType2() == RgvStatusType.WAITING || rgvProtocol.getStatusType2()==RgvStatusType.FETCHWAITING)
+                        && rgvProtocol.getModeType() == RgvModeType.AUTO
+                        && (rgvProtocol.getStatusType() == RgvStatusType.WORKING1)
+                ){
+                    log.info("{}鍙峰皬杞︾瓑寰厀cs纭锛岀姸鎬亄}锛屽弬鏁皗}",rgvProtocol.getRgvNo(),rgvProtocol.getStatusType(),rgvProtocol);
+                    if (rgvProtocol.getTaskNo2() !=0 ){
+                        WrkMastSta wrkMastSta = wrkMastStaMapper.selectByWrkNo(rgvProtocol.getTaskNo1());
+                        if(wrkMastSta.getWrkSts() == 1){//缂鸿揣纭
+                            wrkMastSta.setWrkSts(2);
+                            try{
+                                wrkMastStaMapper.updateById(wrkMastSta);
+                                log.error("鏇存柊灏忚溅浠诲姟鎴愬姛");
+                            }catch (Exception e){
+                                log.error("鏇存柊灏忚溅浠诲姟澶辫触");
+                            }
+                            boolean rgvComplete = false;
+
+                            rgvComplete = rgvComplete((int) rgvProtocol.getRgvNo(),7);
+                            if (!rgvComplete){
+                                log.error("灏忚溅澶嶄綅澶辫触锛屽皬杞﹀彿{}锛�",rgvProtocol.getRgvNo());
+                                break;
+                            }
+                            break;
+                        }
                         if (Cools.isEmpty(wrkMastSta) || wrkMastSta.getWrkSts()!=1){
                             log.error("鏈煡鍒板皬杞︽墽琛屼换鍔℃垨鑰呮墽琛屼换鍔$姸鎬佷笉绗﹀悎锛�"+wrkMastSta);
                             continue;
@@ -2837,12 +2945,8 @@
                         boolean rgvComplete = false;
 
                         //鍙屽伐浣嶅嚭鍏ュ簱涓嶅悓宸ヤ綅澶嶄綅
-                        if((sourceSta >= 1001 && sourceSta <= 1035) || (sourceSta >= 2001 && sourceSta <= 2030)){
-                            rgvComplete = rgvComplete((int) rgvProtocol.getRgvNo(),6);
-                        }else{
-                            rgvComplete = rgvComplete((int) rgvProtocol.getRgvNo(),3);
+                        rgvComplete = rgvComplete((int) rgvProtocol.getRgvNo(),6);
 
-                        }
                         if (!rgvComplete){
                             log.error("灏忚溅澶嶄綅澶辫触锛屽皬杞﹀彿{}锛�",rgvProtocol.getRgvNo());
                             break;
@@ -2857,12 +2961,16 @@
                         BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
                         basRgvMap.setNowRoute(rgvProtocol.getRgvPosI());
                         rgvMapUpdate(basRgvMap,basRgvMap.getStartRoute(),basRgvMap.getStartRoute(),"2471");
-                        rgvThread.setPakMk(true);
                     }
-
                     else {
                         log.error("灏忚溅澶嶄綅澶辫触锛屽皬杞﹀彿{},绛夊緟wcs纭浣嗘槸娌℃湁宸ヤ綔鍙凤紒",rgvProtocol.getRgvNo());
                     }
+                }
+                //褰撳皬杞︽棤浠诲姟鏃跺彇娑堥攣瀹�
+                if(rgvProtocol.getTaskNo1() == 0 && rgvProtocol.getTaskNo2() == 0){
+                    rgvThread.setPakMk(true);
+                    rgvThread.setPakIn(true);
+                    rgvThread.setPakOut(true);
                 }
             }
             }
@@ -2872,183 +2980,496 @@
     }
 
     /**
-     * rgv鍑哄叆搴撲换鍔′笅鍙�
+     * rgv鏀捐揣浠诲姟涓嬪彂
      */
-    public synchronized void rgvIoExecute(Integer mark) {
-        List<BasRgvMap> basRgvMaps = basRgvMapService.selectList(new EntityWrapper<>());
-
-        for (BasRgvMap rgvSlave:basRgvMaps) {
-            // 鑾峰彇鍫嗗灈鏈轰俊鎭�
-            RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgvSlave.getRgvNo());
+    public synchronized void rgvOutExecute() {
+        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(rgvSlave.getRgvNo());
+            BasRgv basRgv = basRgvService.selectById(rgv.getId());
             if (basRgv == null) {
-                log.error("{}鍙稲GV灏氭湭鍦ㄦ暟鎹簱杩涜缁存姢锛�4", rgvSlave.getRgvNo());
+                log.error("{}鍙稲GV灏氭湭鍦ㄦ暟鎹簱杩涜缁存姢锛�4", rgv.getId());
+                continue;
+            }
+            //灏忚溅鏃犱换鍔℃椂璺宠繃
+            if(rgvProtocol.getTaskNo1() ==0 && rgvProtocol.getTaskNo2() == 0){
+                continue;
+            }
+            //鍏ュ簱鏀捐揣
+            if(rgvThread.isPakIn()){
+                for(RgvSlave.RgvStn rgvStn : rgv.getRgvInPStn()){//鍏ュ簱鏀捐揣绔欑偣
+                    boolean flag = false;
+
+                    DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, rgvStn.getDevpPlcId());
+                    StaProtocol staProtocol = devpThread.getStation().get(rgvStn.getStaNo());
+                    if (staProtocol == null) {
+                        News.infoNoLog( " - 1" + " - 1" + " - Rgv鍏ュ簱鏀捐揣绔欎俊鎭�(staProtocol!=null缁х画鎵ц)锛歴taProtocol=" + staProtocol);
+                        continue;
+                    } else {
+                        staProtocol = staProtocol.clone();
+                    }
+                    // 鏌ヨ绔欑偣璇︾粏淇℃伅
+                    BasDevp staDetl = basDevpService.selectById(rgvStn.getStaNo());
+                    if (staDetl == null) {
+                        News.error( " - 1" + " - 2" + " - 鍏ュ簱 ===>>Rgv鏀捐揣绔欑偣鍦ㄦ暟鎹簱涓嶅瓨鍦�, 绔欑偣缂栧彿={}", rgvStn.getStaNo());
+                        continue;
+                    }
+
+                    if (staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.getWorkNo() > 0 && staProtocol.isInEnable()
+                            && staDetl.getCanining() != null && staDetl.getCanining().equals("Y")) {
+                        flag = true;
+                    }
+                    if (!flag) {
+                        News.errorNoLog(  " - 1" + " - 3" + " - Rgv鍏ュ簱鏀捐揣绔欎俊鎭�(浠ヤ笅闇�瑕佸叏true):"
+                                + "鑷姩淇″彿" + staProtocol.isAutoing() + "鏈夌墿淇″彿" + staProtocol.isLoading()
+                                + "宸ヤ綔鍙�>0" + staProtocol.getWorkNo() + "鍙叆淇″彿" + staProtocol.isInEnable()
+                                + "鑳藉叆淇″彿锛坵ms璁剧疆锛�.equals(\"Y\")" + staDetl.getCanining());
+                        continue;
+                    }
+                    BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
+                    List<Integer> route = RouteUtils.getRoute(basRgvMap.getStartRoute(), basRgvMap.getEndRoute());
+                    basRgvMap.setNowRoute(rgvProtocol.getRgvPosI()); //鏇存柊灏忚溅褰撳墠浣嶇疆绔欑偣鍙�
+                    Integer wrkNo = 0;
+                    if(rgvProtocol.getTaskNo2() != 0){
+                        wrkNo = rgvProtocol.getTaskNo2();
+                    }else{
+                        wrkNo = rgvProtocol.getTaskNo1();
+                    }
+                    WrkMastSta wrkMastSta = wrkMastStaMapper.selectNoInterfere(route, route, Long.valueOf(wrkNo));//鏍规嵁绔欑偣宸ヤ綔鍙峰拰灏忚溅宸ヤ綔鑼冨洿妫�绱换鍔℃。
+                    if( null == wrkMastSta ) {
+                        News.infoNoLog( " - 1" + " - 4" + " - 鏌ヨ鏃犲緟鍏ュ簱鏁版嵁--wrk_sts0, 宸ヤ綔鍙�={}", staProtocol.getWorkNo());
+                        continue;
+                    }
+                    boolean sign = rgvTakeFullAll(basRgvMap.getRgvNo(), wrkMastSta,null); //鍛戒护涓嬪彂
+                    if (sign){
+                        try{
+                            wrkMastStaMapper.updateById(wrkMastSta);
+                            log.error("鏇存柊灏忚溅浠诲姟鎴愬姛");
+                        }catch (Exception e){
+                            log.error("鏇存柊灏忚溅浠诲姟澶辫触");
+                        }
+                        boolean signMap = rgvMapUpdate(basRgvMap, wrkMastSta.getStaStart(), wrkMastSta.getStaEnd(),"2526");
+                        if (!signMap){
+                            log.error("璐х墿鎼繍浠诲姟锛氬伐浣滃彿{}鎵�灞炰换鍔′笅鍙戝悗鍦板浘鍚屾澶辫触",wrkMastSta.getWrkNo());
+                        }
+                    } else {
+                        log.error("宸ヤ綔鍙穥}鎵�灞炰换鍔′笅鍙戝け璐�",wrkMastSta.getWrkNo());
+                    }
+
+                }
+            }
+            //鍏ュ簱鏀捐揣
+            if(  rgvThread.isPakOut()){
+                for(RgvSlave.RgvStn rgvStn : rgv.getRgvOutPStn()){//鍏ュ簱鏀捐揣绔欑偣
+                    boolean flag = false;
+
+                    DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, rgvStn.getDevpPlcId());
+                    StaProtocol staProtocol = devpThread.getStation().get(rgvStn.getStaNo());
+                    if (staProtocol == null) {
+                        News.infoNoLog( " - 1" + " - 1" + " - Rgv鍏ュ簱鏀捐揣绔欎俊鎭�(staProtocol!=null缁х画鎵ц)锛歴taProtocol=" + staProtocol);
+                        continue;
+                    } else {
+                        staProtocol = staProtocol.clone();
+                    }
+                    // 鏌ヨ绔欑偣璇︾粏淇℃伅
+                    BasDevp staDetl = basDevpService.selectById(rgvStn.getStaNo());
+                    if (staDetl == null) {
+                        News.error( " - 1" + " - 2" + " - 鍏ュ簱 ===>>Rgv鏀捐揣绔欑偣鍦ㄦ暟鎹簱涓嶅瓨鍦�, 绔欑偣缂栧彿={}", rgvStn.getStaNo());
+                        continue;
+                    }
+
+                    if (staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.getWorkNo() > 0 && staProtocol.isOutEnable()
+                            && staDetl.getCanouting() != null && staDetl.getCanouting().equals("Y")) {
+                        flag = true;
+                    }
+                    if (!flag) {
+                        News.errorNoLog( " - 1" + " - 3" + " - Rgv鍏ュ簱鏀捐揣绔欎俊鎭�(浠ヤ笅闇�瑕佸叏true):"
+                                + "鑷姩淇″彿" + staProtocol.isAutoing() + "鏈夌墿淇″彿" + staProtocol.isLoading()
+                                + "宸ヤ綔鍙�>0" + staProtocol.getWorkNo() + "鍙叆淇″彿" + staProtocol.isOutEnable()
+                                + "鑳藉叆淇″彿锛坵ms璁剧疆锛�.equals(\"Y\")" + staDetl.getCanouting());
+                        continue;
+                    }
+                    BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
+                    List<Integer> route = RouteUtils.getRoute(basRgvMap.getStartRoute(), basRgvMap.getEndRoute());
+                    basRgvMap.setNowRoute(rgvProtocol.getRgvPosI()); //鏇存柊灏忚溅褰撳墠浣嶇疆绔欑偣鍙�
+                    Integer wrkNo = 0;
+                    if(rgvProtocol.getTaskNo1() != 0){
+                        wrkNo = rgvProtocol.getTaskNo1();
+                    }else{
+                        wrkNo = rgvProtocol.getTaskNo2();
+                    }
+                    WrkMastSta wrkMastSta = wrkMastStaMapper.selectNoInterfere(route, route, Long.valueOf(wrkNo));//鏍规嵁绔欑偣宸ヤ綔鍙峰拰灏忚溅宸ヤ綔鑼冨洿妫�绱换鍔℃。
+                    if( null == wrkMastSta ) {
+                        News.infoNoLog( " - 1" + " - 4" + " - 鏌ヨ鏃犲緟鍏ュ簱鏁版嵁--wrk_sts0, 宸ヤ綔鍙�={}", staProtocol.getWorkNo());
+                        continue;
+                    }
+                    wrkMastSta.setWrkSts(2);
+                    boolean sign = rgvTakeFullAll(basRgvMap.getRgvNo(), wrkMastSta,null); //鍛戒护涓嬪彂
+                    if (sign){
+                        try{
+                            wrkMastStaMapper.updateById(wrkMastSta);
+                            log.error("鏇存柊灏忚溅浠诲姟鎴愬姛");
+                        }catch (Exception e){
+                            log.error("鏇存柊灏忚溅浠诲姟澶辫触");
+                        }
+                        boolean signMap = rgvMapUpdate(basRgvMap, wrkMastSta.getStaStart(), wrkMastSta.getStaEnd(),"2526");
+                        if (!signMap){
+                            log.error("璐х墿鎼繍浠诲姟锛氬伐浣滃彿{}鎵�灞炰换鍔′笅鍙戝悗鍦板浘鍚屾澶辫触",wrkMastSta.getWrkNo());
+                        }
+                    } else {
+                        log.error("宸ヤ綔鍙穥}鎵�灞炰换鍔′笅鍙戝け璐�",wrkMastSta.getWrkNo());
+                    }
+
+                }
+            }
+            rgvThread.setPakRgv(true);//浼樺厛鏀捐揣瀹屾垚锛屽紑鍚璋冨害
+        }
+    }
+
+
+
+        /**
+         * rgv鍑哄叆搴撲换鍔′笅鍙�
+         */
+    public synchronized void rgvIoExecute(Integer mark) {
+        List<BasRgvMap> basRgvMaps = basRgvMapService.selectList(new EntityWrapper<>());
+
+        for (RgvSlave rgv : slaveProperties.getRgv()) {
+            // 鑾峰彇鍫嗗灈鏈轰俊鎭�
+            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灏氭湭鍦ㄦ暟鎹簱杩涜缁存姢锛�4", rgv.getId());
                 continue;
             }
 
-            // 鍙湁褰撳爢鍨涙満绌洪棽 骞朵笖 鏃犱换鍔℃椂鎵嶇户缁墽琛�
-            if (rgvProtocol.getStatusType() == CrnStatusType.IDLE && rgvProtocol.getTaskNo() == 0 && rgvProtocol.getModeType() == CrnModeType.AUTO
-                    && rgvProtocol.getLoaded() == 0 && rgvProtocol.getForkPos() == 0) {
-                News.warnNoLog(""+mark+" - 0"+" - 寮�濮嬫墽琛屽爢鍨涙満鍏ュ嚭搴撲綔涓氫笅鍙�");
+            // 鍙湁褰揜GV绌洪棽 骞朵笖 鏃犱换鍔℃椂鎵嶇户缁墽琛�
+            if ((rgvProtocol.getStatusType1() == RgvStatusType.IDLE || rgvProtocol.getStatusType2() == RgvStatusType.IDLE)
+                    && rgvProtocol.getModeType() == RgvModeType.AUTO
+                    && rgvThread.isPakMk()) {
+                News.warnNoLog(""+mark+" - 0"+" - 寮�濮嬫墽琛孯GV鍏ュ嚭搴撲綔涓氫笅鍙�");
                 // 濡傛灉鏈�杩戜竴娆℃槸鍏ュ簱妯″紡
                 if (rgvProtocol.getLastIo().equals("I")) {
-                    if (basCrnp.getInEnable().equals("Y")) {
+                    if (basRgv.getInEnable().equals("Y") && rgvThread.isPakIn()) {
                         //mark - 1 - ....
-                        this.crnStnToLoc(crn, crnProtocol,mark); //  鍏ュ簱
-                        crnProtocol.setLastIo("O");
-                    } else if (basCrnp.getOutEnable().equals("Y")) {
+                        this.rgvRunWrkMastIn(rgv, rgvProtocol,mark); //  鍏ュ簱
+                        rgvProtocol.setLastIo("O");
+                    } else if (basRgv.getOutEnable().equals("Y") && rgvThread.isPakOut()) {
                         //mark - 2 - ....
-                        this.locToCrnStn(crn, crnProtocol,mark); //  鍑哄簱
-                        crnProtocol.setLastIo("I");
+                        this.rgvRunWrkMastOut(rgv, rgvProtocol,mark); //  鍑哄簱
+                        rgvProtocol.setLastIo("I");
                     }
                 }
                 // 濡傛灉鏈�杩戜竴娆℃槸鍑哄簱妯″紡
-                else if (crnProtocol.getLastIo().equals("O")) {
-                    if (basCrnp.getOutEnable().equals("Y")) {
-                        this.locToCrnStn(crn, crnProtocol,mark); //  鍑哄簱
-                        crnProtocol.setLastIo("I");
-                    } else if (basCrnp.getInEnable().equals("Y")) {
-                        this.crnStnToLoc(crn, crnProtocol,mark); //  鍏ュ簱
-                        crnProtocol.setLastIo("O");
+                else if (rgvProtocol.getLastIo().equals("O")) {
+                    if (basRgv.getOutEnable().equals("Y") && rgvThread.isPakOut()) {
+                        this.rgvRunWrkMastOut(rgv, rgvProtocol,mark); //  鍑哄簱
+                        rgvProtocol.setLastIo("I");
+                    } else if (basRgv.getInEnable().equals("Y") && rgvThread.isPakIn()) {
+                        this.rgvRunWrkMastIn(rgv, rgvProtocol,mark); //  鍏ュ簱
+                        rgvProtocol.setLastIo("O");
                     }
                 }
+                WrkMastSta wrkMastSta2 = wrkMastStaMapper.selectByWorkSta(2, (int) rgvProtocol.getRgvNo());
+                WrkMastSta wrkMastSta1 = wrkMastStaMapper.selectByWorkSta(1, (int) rgvProtocol.getRgvNo());
+                if(wrkMastSta1 != null && wrkMastSta2 != null){
+                    rgvThread.setPakMk(false);  //灏忚溅鍙屽伐浣嶉攣瀹�
+                }
+            }
+            if(rgvProtocol.getStatusType1() == RgvStatusType.IDLE && rgvProtocol.getTaskNo1() == 0 && rgvThread.isPakIn() && rgvThread.isPakRgv()){
+                rgvPreScheduling();//鑻ユ殏鏃犱笅鍙戜换鍔¢璋冨害鎻愬墠鍒板彇璐х偣
             }
 
+            if (rgvProtocol.getStatusType1() == RgvStatusType.IDLE && rgvProtocol.getStatusType2() == RgvStatusType.IDLE
+                    && rgvProtocol.getModeType() == RgvModeType.AUTO) {
+                //灏忚溅鎵ц鏀捐揣浠诲姟
+                rgvOutExecute();
+
+            }
         }
-//        News.infoNoLog(""+mark+" - 0"+" - 鍫嗗灈鏈哄叆鍑哄簱浣滀笟涓嬪彂鎵ц瀹屾垚");
+    }
+    /**
+     * 灏忚溅鍏ュ簱浠诲姟鍙栬揣涓嬪彂
+     */
+    public synchronized void rgvRunWrkMastIn(RgvSlave slave, RgvProtocol rgvProtocol,Integer mark) {
+        for (RgvSlave.RgvStn rgvStn : slave.getRgvInTStn()) {//rgv鍏ュ簱鍙栬揣绔欑偣
+            boolean flag = false;
+            //閬嶅巻rgv鍏ュ簱鍙栬揣绔欑偣
+            DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, rgvStn.getDevpPlcId());
+            StaProtocol staProtocol = devpThread.getStation().get(rgvStn.getStaNo());
+            RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, (int) rgvProtocol.getRgvNo());
+
+            if (staProtocol == null) {
+                News.infoNoLog("" + mark + " - 1" + " - 1" + " - Rgv鍏ュ簱绔欎俊鎭�(staProtocol!=null缁х画鎵ц)锛歴taProtocol=" + staProtocol);
+                continue;
+            } else {
+                staProtocol = staProtocol.clone();
+            }
+            // 鏌ヨ绔欑偣璇︾粏淇℃伅
+            BasDevp staDetl = basDevpService.selectById(rgvStn.getStaNo());
+            if (staDetl == null) {
+                News.error("" + mark + " - 1" + " - 2" + " - 鍏ュ簱 ===>>Rgv绔欑偣鍦ㄦ暟鎹簱涓嶅瓨鍦�, 绔欑偣缂栧彿={}", rgvStn.getStaNo());
+                continue;
+            }
+
+
+            if (staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.getWorkNo() > 0 && staProtocol.isInEnable()
+                    && staDetl.getCanining() != null && staDetl.getCanining().equals("Y")) {
+                flag = true;
+            }
+            if (!flag) {
+                News.errorNoLog("" + mark + " - 1" + " - 3" + " - Rgv鍏ュ簱鍙栬揣绔欎俊鎭�(浠ヤ笅闇�瑕佸叏true):"
+                        + "鑷姩淇″彿" + staProtocol.isAutoing() + "鏈夌墿淇″彿" + staProtocol.isLoading()
+                        + "宸ヤ綔鍙�>0" + staProtocol.getWorkNo() + "鍙叆淇″彿" + staProtocol.isInEnable()
+                        + "鑳藉叆淇″彿锛坵ms璁剧疆锛�.equals(\"Y\")" + staDetl.getCanining());
+                continue;
+            }
+            BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
+            List<Integer> route = RouteUtils.getRoute(basRgvMap.getStartRoute(), basRgvMap.getEndRoute());
+            basRgvMap.setNowRoute(rgvProtocol.getRgvPosI()); //鏇存柊灏忚溅褰撳墠浣嶇疆绔欑偣鍙�
+            WrkMastSta wrkMastSta = wrkMastStaMapper.selectNoInterfere(route, route, Long.valueOf(staProtocol.getWorkNo()));//鏍规嵁绔欑偣宸ヤ綔鍙峰拰灏忚溅宸ヤ綔鑼冨洿妫�绱换鍔℃。
+            if( null == wrkMastSta ) {
+                News.infoNoLog("" + mark + " - 1" + " - 4" + " - 鏌ヨ鏃犲緟鍏ュ簱鏁版嵁--wrk_sts0, 宸ヤ綔鍙�={}", staProtocol.getWorkNo());
+                continue;
+            }
+            WrkMastSta wrkMastSta2 = wrkMastStaMapper.selectByWorkSta(2, (int) rgvProtocol.getRgvNo());
+            boolean result = true;
+            if(wrkMastSta2 != null && rgvProtocol.getRgvNo() == 1){ //璺濈璁$畻   2妤煎崟鍏ュ簱鍙d笉闇�瑕佽绠�
+                 result = rgvCalcDistance((int) rgvProtocol.getRgvNo(),wrkMastSta2.getStaEnd(),wrkMastSta.getStaStart());//宸ヤ綅2鏀捐揣绔欑偣锛屽伐浣�1鍙栬揣绔欑偣
+            }
+            if(result){//鑻ュ皬杞﹁窛绂绘斁璐х偣璺濈杩戜簬鍙栬揣鐐瑰垯璺宠繃鍙栬揣 true璺宠繃鍙栬揣/false浼樺厛鍙栬揣
+                rgvThread.setPakRgv(false);
+                continue;
+            }
+            wrkMastSta.setWorkSta(wrkMastSta2 != null ? 1 : 2);
+            wrkMastSta.setRgvNo((int) rgvProtocol.getRgvNo());
+            Short direction = 2;//鍙屽伐浣嶆渶缁堟姷杈句綅缃�
+            boolean sign = rgvTakeFullAll(basRgvMap.getRgvNo(), wrkMastSta,direction); //鍛戒护涓嬪彂
+            if (sign){
+                wrkMastSta.setWrkSts(1);
+                try{
+                    wrkMastStaMapper.updateById(wrkMastSta);
+                    log.error("鏇存柊灏忚溅浠诲姟鎴愬姛");
+                }catch (Exception e){
+                    log.error("鏇存柊灏忚溅浠诲姟澶辫触");
+                }
+                rgvThread.setPakOut(false);//鍑哄簱涓嶅厑璁�
+                boolean signMap = rgvMapUpdate(basRgvMap, wrkMastSta.getStaStart(), wrkMastSta.getStaEnd(),"2526");
+                if (!signMap){
+                    log.error("璐х墿鎼繍浠诲姟锛氬伐浣滃彿{}鎵�灞炰换鍔′笅鍙戝悗鍦板浘鍚屾澶辫触",wrkMastSta.getWrkNo());
+                }
+            } else {
+                log.error("宸ヤ綔鍙穥}鎵�灞炰换鍔′笅鍙戝け璐�",wrkMastSta.getWrkNo());
+            }
+
+
+        }
+    }
+    /**
+     * 灏忚溅鍑哄簱浠诲姟鍙栬揣涓嬪彂
+     */
+    public synchronized void rgvRunWrkMastOut(RgvSlave slave, RgvProtocol rgvProtocol,Integer mark){
+        for (RgvSlave.RgvStn rgvStn : slave.getRgvOutTStn()) {//rgv鍑哄簱鍙栬揣绔欑偣
+            boolean flag = false;
+            //閬嶅巻rgv鍏ュ簱鍙栬揣绔欑偣
+            DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, rgvStn.getDevpPlcId());
+            StaProtocol staProtocol = devpThread.getStation().get(rgvStn.getStaNo());
+            RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, (int) rgvProtocol.getRgvNo());
+
+            if (staProtocol == null) {
+                News.infoNoLog("" + mark + " - 1" + " - 1" + " - Rgv鍑哄簱绔欎俊鎭�(staProtocol!=null缁х画鎵ц)锛歴taProtocol=" + staProtocol);
+                continue;
+            } else {
+                staProtocol = staProtocol.clone();
+            }
+            // 鏌ヨ绔欑偣璇︾粏淇℃伅
+            BasDevp staDetl = basDevpService.selectById(rgvStn.getStaNo());
+            if (staDetl == null) {
+                News.error("" + mark + " - 1" + " - 2" + " - 鍑哄簱 ===>>Rgv绔欑偣鍦ㄦ暟鎹簱涓嶅瓨鍦�, 绔欑偣缂栧彿={}", rgvStn.getStaNo());
+                continue;
+            }
+
+            if (staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.getWorkNo() > 0 && staProtocol.isOutEnable()
+                    && staDetl.getCanouting() != null && staDetl.getCanouting().equals("Y")) {
+                flag = true;
+            }
+            if (!flag) {
+                News.errorNoLog("" + mark + " - 1" + " - 3" + " - Rgv鍑哄簱鍙栬揣绔欎俊鎭�(浠ヤ笅闇�瑕佸叏true):"
+                        + "鑷姩淇″彿" + staProtocol.isAutoing() + "鏈夌墿淇″彿" + staProtocol.isLoading()
+                        + "宸ヤ綔鍙�>0" + staProtocol.getWorkNo() + "鍙叆淇″彿" + staProtocol.isOutEnable()
+                        + "鑳藉叆淇″彿锛坵ms璁剧疆锛�.equals(\"Y\")" + staDetl.getCanouting());
+                continue;
+            }
+            BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
+            List<Integer> route = RouteUtils.getRoute(basRgvMap.getStartRoute(), basRgvMap.getEndRoute());
+            basRgvMap.setNowRoute(rgvProtocol.getRgvPosI()); //鏇存柊灏忚溅褰撳墠浣嶇疆绔欑偣鍙�
+            WrkMastSta wrkMastSta = wrkMastStaMapper.selectNoInterfere(route, route, Long.valueOf(staProtocol.getWorkNo()));//鏍规嵁绔欑偣宸ヤ綔鍙峰拰灏忚溅宸ヤ綔鑼冨洿妫�绱换鍔℃。
+            if( null == wrkMastSta ) {
+                News.infoNoLog("" + mark + " - 1" + " - 4" + " - 鏌ヨ鏃犲緟鍏ュ簱鏁版嵁--wrk_sts0, 宸ヤ綔鍙�={}", staProtocol.getWorkNo());
+                continue;
+            }
+            WrkMastSta wrkMastSta1 = wrkMastStaMapper.selectByWorkSta(1, (int) rgvProtocol.getRgvNo());
+            wrkMastSta.setWorkSta(wrkMastSta1 != null ? 2 : 1);//鑻�1鍙峰伐浣嶆湁浠诲姟缁�2鍙峰伐浣�
+            wrkMastSta.setRgvNo((int) rgvProtocol.getRgvNo());
+
+            Short direction = 1;//宸ヤ綅1鏂瑰悜
+            boolean sign = rgvTakeFullAll(basRgvMap.getRgvNo(), wrkMastSta, direction); //鍛戒护涓嬪彂
+            if (sign){
+                wrkMastSta.setWrkSts(1);
+                try{
+                    wrkMastStaMapper.updateById(wrkMastSta);
+                    log.error("鏇存柊灏忚溅浠诲姟鎴愬姛");
+                }catch (Exception e){
+                    log.error("鏇存柊灏忚溅浠诲姟澶辫触");
+                }
+                rgvThread.setPakIn(false);//鍏ュ簱涓嶅厑璁�
+                boolean signMap = rgvMapUpdate(basRgvMap, wrkMastSta.getStaStart(), wrkMastSta.getStaEnd(),"2526");
+                if (!signMap){
+                    log.error("璐х墿鎼繍浠诲姟锛氬伐浣滃彿{}鎵�灞炰换鍔′笅鍙戝悗鍦板浘鍚屾澶辫触",wrkMastSta.getWrkNo());
+                }
+            } else {
+                log.error("宸ヤ綔鍙穥}鎵�灞炰换鍔′笅鍙戝け璐�",wrkMastSta.getWrkNo());
+            }
+
+
+        }
     }
     /**
      * 鎵ц灏忚溅鎼繍浠诲姟
      *
      * @return
      */
-    public synchronized boolean rgvRunWrkMastFullSta() {
-        boolean wrkEnable = false;
-        try{
-            List<BasRgvMap> basRgvMaps = basRgvMapService.selectList(new EntityWrapper<>());
-            for (BasRgvMap rgvSlave:basRgvMaps) {
-                RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgvSlave.getRgvNo());
-                RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
-                if (rgvProtocol == null) {
-                    continue;
-                }else {
-                    rgvProtocol = rgvProtocol.clone();
-                }
-                BasRgv basRgv = basRgvService.selectById(rgvSlave.getRgvNo());
-                if (basRgv == null) {
-                    log.error("{}鍙稲GV灏氭湭鍦ㄦ暟鎹簱杩涜缁存姢锛�4", rgvSlave.getRgvNo());
-                    continue;
-                }
-
-                // 鍙湁褰揜GV绌洪棽銆佽嚜鍔�,宸ヤ綅涓�鏃犵墿//rgv鍙敤  鍏ュ簱鍙栬揣
-                if (rgvProtocol.getStatusType() == RgvStatusType.IDLE
-                        && rgvProtocol.getModeType() == RgvModeType.AUTO
-                        && !rgvProtocol.isLoaded1ing()
-                        && rgvProtocol.getTaskNo1() == 0
-                        && rgvThread.isPakMk()
-                        && rgvThread.isPakIn()
-                ) {
-                    BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
-                    if (basRgvMap == null) {
-                        log.error("{}鍙稲GV灏氭湭鍦ㄦ暟鎹簱鍦板浘涓繘琛岀淮鎶わ紒", rgvProtocol.getRgvNo());
-                        continue;
-                    }
-                    List<Integer> route = RouteUtils.getRoute(basRgvMap.getStartRoute(), basRgvMap.getEndRoute());
-                    basRgvMap.setNowRoute(rgvProtocol.getRgvPosI()); //鏇存柊灏忚溅褰撳墠浣嶇疆绔欑偣鍙�
-                    List<WrkMastSta> wrkMastStaList = wrkMastStaMapper.selectNoInterfereList(route, route);
-                    for (WrkMastSta wrkMastSta : wrkMastStaList){
-                        List<Integer> staNos = Arrays.asList(1042, 1105, 1038, 1036, 2037);//鍏ュ簱鍙�
-                        if (!staNos.contains(wrkMastSta.getStaStart())) {
-                            continue;
-                        }
-                        boolean sign = rgvTakeFullAll(basRgvMap.getRgvNo(), wrkMastSta); //鍛戒护涓嬪彂
-                        wrkEnable = true;
-                        if (sign){
-                            wrkMastSta.setWrkSts(1);
-                            try{
-                                wrkMastStaMapper.updateById(wrkMastSta);
-                                log.error("鏇存柊灏忚溅浠诲姟鎴愬姛");
-                            }catch (Exception e){
-                                log.error("鏇存柊灏忚溅浠诲姟澶辫触");
-                            }
-                            rgvThread.setPakMk(false);
-                            rgvThread.setPakOut(false);
-                            boolean signMap = rgvMapUpdate(basRgvMap, wrkMastSta.getStaStart(), wrkMastSta.getStaEnd(),"2526");
-                            if (signMap){
-                                return wrkEnable;
-//                                break;
-                            }else {
-                                log.error("璐х墿鎼繍浠诲姟锛氬伐浣滃彿{}鎵�灞炰换鍔′笅鍙戝悗鍦板浘鍚屾澶辫触",wrkMastSta.getWrkNo());
-                                Thread.sleep(500);
-                            }
-                        } else {
-                            log.error("宸ヤ綔鍙穥}鎵�灞炰换鍔′笅鍙戝け璐�",wrkMastSta.getWrkNo());
-                            Thread.sleep(500);
-                        }
-                        break;
-                    }
-                }
-
-                // 鍙湁褰揜GV绌洪棽銆佽嚜鍔�,宸ヤ綅涓�鏃犵墿//rgv鍙敤  鍑哄簱鍙栬揣
-                if (rgvProtocol.getStatusType() == RgvStatusType.IDLE
-                        && rgvProtocol.getModeType() == RgvModeType.AUTO
-                        && !rgvProtocol.isLoaded2ing()
-                        && rgvProtocol.getTaskNo2() == 0
-                        && rgvThread.isPakMk()
-                        && rgvThread.isPakOut()
-                ){
-                    BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
-                    if (basRgvMap == null) {
-                        log.error("{}鍙稲GV灏氭湭鍦ㄦ暟鎹簱鍦板浘涓繘琛岀淮鎶わ紒", rgvProtocol.getRgvNo());
-                        continue;
-                    }
-                    List<Integer> route = RouteUtils.getRoute(basRgvMap.getStartRoute(), basRgvMap.getEndRoute());
-                    basRgvMap.setNowRoute(rgvProtocol.getRgvPosI()); //鏇存柊灏忚溅褰撳墠浣嶇疆绔欑偣鍙�
-                    List<WrkMastSta> wrkMastStaList = wrkMastStaMapper.selectNoInterfereList(route, route);
-                    for (WrkMastSta wrkMastSta : wrkMastStaList){
-                        List<Integer> staNos = Arrays.asList(1042, 1105, 1038, 1036, 2037);//鍏ュ簱鍙�
-                        if (staNos.contains(wrkMastSta.getStaStart())) {//闈炲叆搴撳彛锛堝嚭搴撳彛锛夐檺鍒�
-                            continue;
-                        }
-                        boolean sign = rgvTakeFullAll(basRgvMap.getRgvNo(), wrkMastSta); //鍛戒护涓嬪彂
-                        wrkEnable = true;
-                        if (sign){
-                            wrkMastSta.setWrkSts(1);
-                            try{
-                                wrkMastStaMapper.updateById(wrkMastSta);
-                                log.error("鏇存柊灏忚溅浠诲姟鎴愬姛");
-                            }catch (Exception e){
-                                log.error("鏇存柊灏忚溅浠诲姟澶辫触");
-                            }
-                            rgvThread.setPakMk(false);
-                            rgvThread.setPakOut(false);
-                            boolean signMap = rgvMapUpdate(basRgvMap, wrkMastSta.getStaStart(), wrkMastSta.getStaEnd(),"2526");
-                            if (signMap){
-                                return wrkEnable;
-//                                break;
-                            }else {
-                                log.error("璐х墿鎼繍浠诲姟锛氬伐浣滃彿{}鎵�灞炰换鍔′笅鍙戝悗鍦板浘鍚屾澶辫触",wrkMastSta.getWrkNo());
-                                Thread.sleep(500);
-                            }
-                        } else {
-                            log.error("宸ヤ綔鍙穥}鎵�灞炰换鍔′笅鍙戝け璐�",wrkMastSta.getWrkNo());
-                            Thread.sleep(500);
-                        }
-                        break;
-                    }
-
-                }
-
-            }
-        }catch (Exception e){
-            log.error("鎵ц灏忚溅鎼繍浠诲姟涓嬪彂澶辫触");
-        }
-        return wrkEnable;
-    }
+//    public synchronized boolean rgvRunWrkMastFullSta() {
+//        boolean wrkEnable = false;
+//        try{
+//            List<BasRgvMap> basRgvMaps = basRgvMapService.selectList(new EntityWrapper<>());
+//            for (BasRgvMap rgvSlave:basRgvMaps) {
+//                RgvThread rgvThread = (RgvThread) SlaveConnection.get(SlaveType.Rgv, rgvSlave.getRgvNo());
+//                RgvProtocol rgvProtocol = rgvThread.getRgvProtocol();
+//                if (rgvProtocol == null) {
+//                    continue;
+//                }else {
+//                    rgvProtocol = rgvProtocol.clone();
+//                }
+//                BasRgv basRgv = basRgvService.selectById(rgvSlave.getRgvNo());
+//                if (basRgv == null) {
+//                    log.error("{}鍙稲GV灏氭湭鍦ㄦ暟鎹簱杩涜缁存姢锛�4", rgvSlave.getRgvNo());
+//                    continue;
+//                }
+//
+//                // 鍙湁褰揜GV绌洪棽銆佽嚜鍔�,宸ヤ綅涓�鏃犵墿//rgv鍙敤  鍏ュ簱鍙栬揣
+//                if (rgvProtocol.getStatusType() == RgvStatusType.IDLE
+//                        && rgvProtocol.getModeType() == RgvModeType.AUTO
+//                        && !rgvProtocol.isLoaded1ing()
+//                        && rgvProtocol.getTaskNo1() == 0
+//                        && rgvThread.isPakMk()
+//                        && rgvThread.isPakIn()
+//                ) {
+//                    BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
+//                    if (basRgvMap == null) {
+//                        log.error("{}鍙稲GV灏氭湭鍦ㄦ暟鎹簱鍦板浘涓繘琛岀淮鎶わ紒", rgvProtocol.getRgvNo());
+//                        continue;
+//                    }
+//                    List<Integer> route = RouteUtils.getRoute(basRgvMap.getStartRoute(), basRgvMap.getEndRoute());
+//                    basRgvMap.setNowRoute(rgvProtocol.getRgvPosI()); //鏇存柊灏忚溅褰撳墠浣嶇疆绔欑偣鍙�
+//                    List<WrkMastSta> wrkMastStaList = wrkMastStaMapper.selectNoInterfereList(route, route);
+//                    for (WrkMastSta wrkMastSta : wrkMastStaList){
+//                        List<Integer> staNos = Arrays.asList(1042, 1105, 1038, 1036, 2037);//鍏ュ簱鍙�
+//                        if (!staNos.contains(wrkMastSta.getStaStart())) {
+//                            continue;
+//                        }
+//                        boolean sign = rgvTakeFullAll(basRgvMap.getRgvNo(), wrkMastSta); //鍛戒护涓嬪彂
+//                        wrkEnable = true;
+//                        if (sign){
+//                            wrkMastSta.setWrkSts(1);
+//                            try{
+//                                wrkMastStaMapper.updateById(wrkMastSta);
+//                                log.error("鏇存柊灏忚溅浠诲姟鎴愬姛");
+//                            }catch (Exception e){
+//                                log.error("鏇存柊灏忚溅浠诲姟澶辫触");
+//                            }
+//                            rgvThread.setPakMk(false);
+//                            rgvThread.setPakOut(false);
+//                            boolean signMap = rgvMapUpdate(basRgvMap, wrkMastSta.getStaStart(), wrkMastSta.getStaEnd(),"2526");
+//                            if (signMap){
+//                                return wrkEnable;
+////                                break;
+//                            }else {
+//                                log.error("璐х墿鎼繍浠诲姟锛氬伐浣滃彿{}鎵�灞炰换鍔′笅鍙戝悗鍦板浘鍚屾澶辫触",wrkMastSta.getWrkNo());
+//                                Thread.sleep(500);
+//                            }
+//                        } else {
+//                            log.error("宸ヤ綔鍙穥}鎵�灞炰换鍔′笅鍙戝け璐�",wrkMastSta.getWrkNo());
+//                            Thread.sleep(500);
+//                        }
+//                        break;
+//                    }
+//                }
+//
+//                // 鍙湁褰揜GV绌洪棽銆佽嚜鍔�,宸ヤ綅涓�鏃犵墿//rgv鍙敤  鍑哄簱鍙栬揣
+//                if (rgvProtocol.getStatusType() == RgvStatusType.IDLE
+//                        && rgvProtocol.getModeType() == RgvModeType.AUTO
+//                        && !rgvProtocol.isLoaded2ing()
+//                        && rgvProtocol.getTaskNo2() == 0
+//                        && rgvThread.isPakMk()
+//                        && rgvThread.isPakOut()
+//                ){
+//                    BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvProtocol.getRgvNo());
+//                    if (basRgvMap == null) {
+//                        log.error("{}鍙稲GV灏氭湭鍦ㄦ暟鎹簱鍦板浘涓繘琛岀淮鎶わ紒", rgvProtocol.getRgvNo());
+//                        continue;
+//                    }
+//                    List<Integer> route = RouteUtils.getRoute(basRgvMap.getStartRoute(), basRgvMap.getEndRoute());
+//                    basRgvMap.setNowRoute(rgvProtocol.getRgvPosI()); //鏇存柊灏忚溅褰撳墠浣嶇疆绔欑偣鍙�
+//                    List<WrkMastSta> wrkMastStaList = wrkMastStaMapper.selectNoInterfereList(route, route);
+//                    for (WrkMastSta wrkMastSta : wrkMastStaList){
+//                        List<Integer> staNos = Arrays.asList(1042, 1105, 1038, 1036, 2037);//鍏ュ簱鍙�
+//                        if (staNos.contains(wrkMastSta.getStaStart())) {//闈炲叆搴撳彛锛堝嚭搴撳彛锛夐檺鍒�
+//                            continue;
+//                        }
+//                        boolean sign = rgvTakeFullAll(basRgvMap.getRgvNo(), wrkMastSta); //鍛戒护涓嬪彂
+//                        wrkEnable = true;
+//                        if (sign){
+//                            wrkMastSta.setWrkSts(1);
+//                            try{
+//                                wrkMastStaMapper.updateById(wrkMastSta);
+//                                log.error("鏇存柊灏忚溅浠诲姟鎴愬姛");
+//                            }catch (Exception e){
+//                                log.error("鏇存柊灏忚溅浠诲姟澶辫触");
+//                            }
+//                            rgvThread.setPakMk(false);
+//                            rgvThread.setPakOut(false);
+//                            boolean signMap = rgvMapUpdate(basRgvMap, wrkMastSta.getStaStart(), wrkMastSta.getStaEnd(),"2526");
+//                            if (signMap){
+//                                return wrkEnable;
+////                                break;
+//                            }else {
+//                                log.error("璐х墿鎼繍浠诲姟锛氬伐浣滃彿{}鎵�灞炰换鍔′笅鍙戝悗鍦板浘鍚屾澶辫触",wrkMastSta.getWrkNo());
+//                                Thread.sleep(500);
+//                            }
+//                        } else {
+//                            log.error("宸ヤ綔鍙穥}鎵�灞炰换鍔′笅鍙戝け璐�",wrkMastSta.getWrkNo());
+//                            Thread.sleep(500);
+//                        }
+//                        break;
+//                    }
+//
+//                }
+//
+//            }
+//        }catch (Exception e){
+//            log.error("鎵ц灏忚溅鎼繍浠诲姟涓嬪彂澶辫触");
+//        }
+//        return wrkEnable;
+//    }
     /**
      * 灏忚溅棰勮皟搴�
      */
@@ -3088,7 +3509,6 @@
                     // 鏍规嵁杈撻�佺嚎plc閬嶅巻
                     for (DevpSlave devp : slaveProperties.getDevp()) {
                         // 閬嶅巻鍏ュ簱鍙�  鍏ュ簱棰勮皟搴�
-                        for()
                         List<Integer> staNos = Arrays.asList(1042, 1043, 1105, 1104);
                         for (Integer staNo : staNos) {
                             SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, devp.getId());
@@ -3098,7 +3518,7 @@
                                 rgvCommand.setRgvNo((int) rgvProtocol.getRgvNo()); // RGV缂栧彿
                                 rgvCommand.setAckFinish1(false);  // 宸ヤ綅1浠诲姟瀹屾垚纭浣�
                                 rgvCommand.setTaskNo1(9999); // 宸ヤ綅1宸ヤ綔鍙�
-                                rgvCommand.setTaskMode1(RgvTaskModeType.X_MOVE); // 宸ヤ綅1浠诲姟妯″紡:  鍙栨斁璐�
+                                rgvCommand.setTaskMode1(RgvTaskModeType.X_MOVE); // 宸ヤ綅1浠诲姟妯″紡:  绉诲姩
                                 rgvCommand.setEndStaNo1(0);   //宸ヤ綅1 鏀捐揣鍚庤鍘荤殑浣嶇疆
                                 if(staNo == 1042 || staNo ==1043){
                                     rgvCommand.setTargetPosition1(1042);   //宸ヤ綅1鐩爣绔欑偣
@@ -3359,29 +3779,30 @@
     /*
      * 灏忚溅鍙栬揣鑷冲伐浣嶄换鍔�
      * */
-    public synchronized boolean rgvTakeFullAll(Integer rgvId,WrkMastSta wrkMastSta){
+    public synchronized boolean rgvTakeFullAll(Integer rgvId,WrkMastSta wrkMastSta,Short direction){
         try{
-            int startSta = wrkMastSta.getStaStart();
             //  鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
             RgvCommand rgvCommand = new RgvCommand();
             boolean pakIn1 = true;
             boolean pakIn2 = true;
             rgvCommand.setRgvNo(rgvId); // RGV缂栧彿
-            if(wrkMastSta.getWrkSts() == 1){//鍙栬揣
-                if((startSta >= 1001 && startSta <= 1035) || (startSta >= 2001 && startSta <= 2030)){//鍑哄簱RGV鍙栬揣
+            if(wrkMastSta.getWrkSts() == 0){//鍙栬揣
+                if(wrkMastSta.getWorkSta() == 2){//鍑哄簱RGV鍙栬揣
                     rgvCommand.setAckFinish2(false);  // 宸ヤ綅2浠诲姟瀹屾垚纭浣�
                     rgvCommand.setTaskNo2(Math.toIntExact(wrkMastSta.getWrkNo())); // 宸ヤ綅2宸ヤ綔鍙�
-                    rgvCommand.setTaskMode2(RgvTaskModeType.FETCH); // 宸ヤ綅2浠诲姟妯″紡:  鍙栨斁璐�
+                    rgvCommand.setTaskStatus2(RgvTaskStatusType.FETCH); // 宸ヤ綅2浠诲姟妯″紡:  鍙栨斁璐�
                     rgvCommand.setEndStaNo2(wrkMastSta.getWrkEnd());   //宸ヤ綅2 鏀捐揣鍚庤鍘荤殑浣嶇疆
                     rgvCommand.setTargetPosition2(wrkMastSta.getStaStart());   //宸ヤ綅2鐩爣绔欑偣
+                    rgvCommand.setDirection2(direction);
                     rgvCommand.setCommand(true);   //宸ヤ綅1浠诲姟纭
                     pakIn1 = false;
                 }else{  //鍏ュ簱RGV鍙栬揣
                     rgvCommand.setAckFinish1(false);  // 宸ヤ綅1浠诲姟瀹屾垚纭浣�
                     rgvCommand.setTaskNo1(Math.toIntExact(wrkMastSta.getWrkNo())); // 宸ヤ綅1宸ヤ綔鍙�
-                    rgvCommand.setTaskMode1(RgvTaskModeType.FETCH); // 宸ヤ綅1浠诲姟妯″紡:  鍙栨斁璐�
+                    rgvCommand.setTaskStatus1(RgvTaskStatusType.FETCH); // 宸ヤ綅1浠诲姟妯″紡:  鍙栨斁璐�
                     rgvCommand.setEndStaNo1(wrkMastSta.getWrkEnd());   //宸ヤ綅1 鏀捐揣鍚庤鍘荤殑浣嶇疆
                     rgvCommand.setTargetPosition1(wrkMastSta.getStaStart());   //宸ヤ綅1鐩爣绔欑偣
+                    rgvCommand.setDirection1(direction);
                     rgvCommand.setCommand(true);   //宸ヤ綅1浠诲姟纭
                 }
                 if(!pakIn1){
@@ -3403,18 +3824,18 @@
                 }
             }
             if(wrkMastSta.getWrkSts() == 2) {//鏀捐揣
-                if((startSta >= 1001 && startSta <= 1035) || (startSta >= 2001 && startSta <= 2030)){//鍑哄簱RGV鍙栬揣
+                if((wrkMastSta.getWorkSta() == 2)){ //宸ヤ綅2浠诲姟鏀捐揣
                     rgvCommand.setAckFinish2(false);  // 宸ヤ綅2浠诲姟瀹屾垚纭浣�
                     rgvCommand.setTaskNo2(Math.toIntExact(wrkMastSta.getWrkNo())); // 宸ヤ綅2宸ヤ綔鍙�
-                    rgvCommand.setTaskMode2(RgvTaskModeType.PUT); // 宸ヤ綅2浠诲姟妯″紡:  鍙栨斁璐�
+                    rgvCommand.setTaskStatus2(RgvTaskStatusType.PUT); // 宸ヤ綅2浠诲姟妯″紡:  鏀捐揣
                     rgvCommand.setEndStaNo2(wrkMastSta.getWrkEnd());   //宸ヤ綅2 鏀捐揣鍚庤鍘荤殑浣嶇疆
                     rgvCommand.setTargetPosition2(wrkMastSta.getStaEnd());   //宸ヤ綅2鐩爣绔欑偣
                     rgvCommand.setCommand(true);   //宸ヤ綅1浠诲姟纭
                     pakIn2 = false;
-                }else{  //鍏ュ簱RGV鍙栬揣
+                }else{  //宸ヤ綅1浠诲姟鏀捐揣
                     rgvCommand.setAckFinish1(false);  // 宸ヤ綅1浠诲姟瀹屾垚纭浣�
                     rgvCommand.setTaskNo1(Math.toIntExact(wrkMastSta.getWrkNo())); // 宸ヤ綅1宸ヤ綔鍙�
-                    rgvCommand.setTaskMode1(RgvTaskModeType.PUT); // 宸ヤ綅1浠诲姟妯″紡:  鍙栨斁璐�
+                    rgvCommand.setTaskStatus1(RgvTaskStatusType.PUT); // 宸ヤ綅1浠诲姟妯″紡:  鏀捐揣
                     rgvCommand.setEndStaNo1(wrkMastSta.getWrkEnd());   //宸ヤ綅1 鏀捐揣鍚庤鍘荤殑浣嶇疆
                     rgvCommand.setTargetPosition1(wrkMastSta.getStaEnd());   //宸ヤ綅1鐩爣绔欑偣
                     rgvCommand.setCommand(true);   //宸ヤ綅1浠诲姟纭
@@ -3543,6 +3964,37 @@
 //        }
 //    }
 
+    /**
+     *  鍙栨斁鍙栬矾寰勮绠�
+     */
+    public synchronized boolean rgvCalcDistance(Integer rgvNo, Integer outStn, Integer inStn){
+        try {
+            // 灏忚溅褰撳墠浣嶇疆
+            BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvNo);
+            Integer currPos = basRgvMap.getNowRoute(); // 鎴栬�呯敤 rgvProtocol.getRgvPosI()
+
+            if(currPos == null || outStn == null || inStn == null){
+                return false; // 鏃犳晥鏁版嵁鐩存帴鏀惧純
+            }
+
+            // 璁$畻涓ゆ璺濈
+            List<Integer> routeToOut = RouteUtils.getRouteDis(currPos, outStn);
+            List<Integer> routeToIn  = RouteUtils.getRouteDis(currPos, inStn);
+
+            int distOut = (routeToOut != null) ? routeToOut.size() : Integer.MAX_VALUE;
+            int distIn  = (routeToIn  != null) ? routeToIn.size()  : Integer.MAX_VALUE;
+
+            // 璋冭瘯鏃ュ織
+            log.info("RGV璺濈璁$畻: currPos={}, outStn={}, distOut={}, inStn={}, distIn={}",
+                    currPos, outStn, distOut, inStn, distIn);
+
+            return distOut < distIn; // 鏀捐揣鐐规洿杩� 鈫� true
+        } catch (Exception e) {
+            log.error("RGV璺緞璺濈璁$畻寮傚父", e);
+            return false;
+        }
+    }
+
     /*
      * 灏忚溅澶嶄綅
      * */
diff --git a/src/main/java/com/zy/asrs/utils/RouteUtils.java b/src/main/java/com/zy/asrs/utils/RouteUtils.java
index 67ea7ab..c43386e 100644
--- a/src/main/java/com/zy/asrs/utils/RouteUtils.java
+++ b/src/main/java/com/zy/asrs/utils/RouteUtils.java
@@ -2,8 +2,7 @@
 
 import com.zy.core.enums.RouteCollectCountType;
 
-import java.util.ArrayList;
-import java.util.List;
+import java.util.*;
 
 import static java.util.stream.Collectors.toList;
 
@@ -29,14 +28,33 @@
 //        add(116);add(117);
     }};
 
-//    姝e簭
-    public static final List<Integer> TRACK_POSITION_POSITIVE_SEQUENCE = new ArrayList<Integer>() {{
-        add(161);add(157);add(153);add(149);add(119);add(124);add(113);add(112);add(107);add(106);add(101);add(100);
-    }};
-//    鍙嶅簭
-    public static final List<Integer> TRACK_POSITION_REVERSE_SEQUENCE = new ArrayList<Integer>() {{
-        add(100);add(101);add(106);add(107);add(112);add(113);add(124);add(119);add(149);add(153);add(157);add(161);
-    }};
+    // RGV杞ㄩ亾姝e簭锛堜粠涓婂埌涓嬶級
+    public static final List<Integer> TRACK_POSITION_POSITIVE_SEQUENCE = Arrays.asList(
+        1004,1007,1010,1014,1018,1021,1024,1028,1031,1035
+    );
+
+    // 鍙嶅簭锛堢洿鎺ュ弽杞敓鎴愶級
+    public static final List<Integer> TRACK_POSITION_REVERSE_SEQUENCE = new ArrayList<>(TRACK_POSITION_POSITIVE_SEQUENCE);
+    static {
+        Collections.reverse(TRACK_POSITION_REVERSE_SEQUENCE);
+    }
+
+    // 杞ㄩ亾鏄犲皠锛堟妸鏄犲皠绔欑偣鏇挎崲鎴愪富绔欑偣锛�
+    public static final Map<Integer, Integer> SITE_MAPPING = new HashMap<>();
+    static {
+        SITE_MAPPING.put(1042, 1004);
+        SITE_MAPPING.put(1105, 1007);
+        SITE_MAPPING.put(1106, 1010);
+        SITE_MAPPING.put(1041, 1024);
+        SITE_MAPPING.put(1038, 1028);
+        SITE_MAPPING.put(1036, 1035);
+    }
+
+    // 鑾峰彇杞ㄩ亾鍒楄〃涓疄闄呯珯鐐�
+    private static Integer mapSite(Integer site) {
+        return SITE_MAPPING.getOrDefault(site, site);
+    }
+
 
     public static String zerofill(String msg, Integer count){
         if (msg.length() == count){
@@ -51,6 +69,7 @@
             return msgBuilder.toString();
         }
     }
+
     /*
      * 鑾峰彇骞叉秹鏈�杩滅珯鐐�
      * */
@@ -75,6 +94,30 @@
         return staFall.get(indexNo);
     }
 
+    // 鑾峰彇褰撳墠灏忚溅鏈璧扮殑璺嚎闆嗗悎
+    public static List<Integer> getRouteDis(Integer groupStart, Integer groupEnd) {
+        groupStart = mapSite(groupStart);
+        groupEnd = mapSite(groupEnd);
+
+        int startIdx = TRACK_POSITION_POSITIVE_SEQUENCE.indexOf(groupStart);
+        int endIdx = TRACK_POSITION_POSITIVE_SEQUENCE.indexOf(groupEnd);
+
+        if (startIdx == -1 || endIdx == -1) return null;
+
+        boolean forward = startIdx < endIdx;
+        List<Integer> route = forward ? TRACK_POSITION_POSITIVE_SEQUENCE : TRACK_POSITION_REVERSE_SEQUENCE;
+
+        List<Integer> result = new ArrayList<>();
+        boolean addFlag = false;
+        for (Integer s : route) {
+            s = mapSite(s);
+            if (s.equals(groupStart)) addFlag = true;
+            if (addFlag) result.add(s);
+            if (s.equals(groupEnd)) break;
+        }
+        return result;
+    }
+
 
     // 鑾峰彇褰撳墠灏忚溅鏈璧扮殑璺嚎闆嗗悎
     public static List<Integer> getRoute(Integer groupStart,Integer groupEnd){
diff --git a/src/main/java/com/zy/core/MainProcess.java b/src/main/java/com/zy/core/MainProcess.java
index 4e09342..9a5ab61 100644
--- a/src/main/java/com/zy/core/MainProcess.java
+++ b/src/main/java/com/zy/core/MainProcess.java
@@ -123,13 +123,8 @@
 
                     // RGV  ===>>  灏忚溅浠诲姟浣滀笟涓嬪彂
                     try{
-                        //RGV灏忚溅鍑哄叆鍙d笅鍙�
+                        //RGV灏忚溅鍑哄叆搴撳彇璐т笅鍙�
                         mainService.rgvIoExecute(11);
-                        //灏忚溅鍙栬揣涓嬪彂
-                        mainService.rgvRunWrkMastFullSta();
-                        //灏忚溅鏀捐揣浠诲姟鏇存柊
-                        //灏忚溅棰勮皟搴�
-                        mainService.rgvPreScheduling();
                     }catch (Exception e){
                         log.error("RGV  ===>>  灏忚溅浠诲姟浣滀笟涓嬪彂寮傚父"+e);
                     }
diff --git a/src/main/java/com/zy/core/model/protocol/RgvProtocol.java b/src/main/java/com/zy/core/model/protocol/RgvProtocol.java
index eb177fa..8e1746f 100644
--- a/src/main/java/com/zy/core/model/protocol/RgvProtocol.java
+++ b/src/main/java/com/zy/core/model/protocol/RgvProtocol.java
@@ -26,6 +26,9 @@
 
     public RgvModeType modeType;
 
+    private transient Long loadingStartTime;
+
+
     /**
      * RGV褰撳墠鐘舵�佸伐浣�1
      * 0锛氱┖闂诧紝鏃犱换鍔�
@@ -296,12 +299,16 @@
     public Integer getRgvPosI(){
         //闇�瑕佹牴鎹幇鍦烘敼閫�  鏍规嵁璇诲埌鐨勫�艰幏鍙栧搴旂珯鐐逛綅缃�
         Map<Short,Integer> map = new HashMap<>();
-        map.put((short) 1,100);map.put((short) 2,101);
-        map.put((short) 3,106);map.put((short) 4,107);
-        map.put((short) 5,112);map.put((short) 6,113);
-       map.put((short) 7,124); map.put((short) 8,119);
-        map.put((short) 9,149);map.put((short) 10,153);
-        map.put((short) 11,157);map.put((short) 12,161);
+        map.put((short) 1,1004);map.put((short) 2,1007);
+        map.put((short) 3,1010);map.put((short) 4,1014);
+        map.put((short) 5,1018);map.put((short) 6,1021);
+       map.put((short) 7,1024); map.put((short) 8,1028);
+        map.put((short) 9,1031);map.put((short) 10,1035);
+        map.put((short) 11,2003);map.put((short) 12,2006);
+        map.put((short) 13,2009);map.put((short) 14,2012);
+        map.put((short) 15,2015);map.put((short) 16,2018);
+        map.put((short) 17,2021);map.put((short) 18,2024);
+        map.put((short) 19,2027);map.put((short) 20,2030);
         if (RgvPos==null) return 0;
 
         return map.get(RgvPos);
diff --git a/src/main/java/com/zy/core/thread/RgvThread.java b/src/main/java/com/zy/core/thread/RgvThread.java
index 67269ed..65736ca 100644
--- a/src/main/java/com/zy/core/thread/RgvThread.java
+++ b/src/main/java/com/zy/core/thread/RgvThread.java
@@ -57,6 +57,8 @@
     private boolean PakIn = true;
     //鍑哄簱鏍囪
     private boolean PakOut = true;
+    //鏍规嵁璺濈璺宠繃鍙栬揣
+    private boolean PakRgv = true;
 
     public RgvThread(RgvSlave slave) {
         this.slave = slave;
@@ -119,6 +121,30 @@
                         command2.setCommand(false);
                         write2(command2);
                         break;
+                    case 7: //宸ヤ綅1鍙栬揣纭
+                        RgvCommand command3 = (RgvCommand) task.getData();
+                        if (null == command3) {
+                            command3 = new RgvCommand();
+                        }
+                        command3.setRgvNo(slave.getId()); // RGV缂栧彿
+                        command3.setAckFinish1(true);  // 浠诲姟瀹屾垚纭浣�
+                        command3.setTaskStatus1(RgvTaskStatusType.NONE); // 浠诲姟妯″紡
+                        command3.setTargetPosition1( 0);     // 婧愮珯
+                        command3.setCommand(false);
+                        write1(command3);
+                        break;
+                    case 8 :
+                        RgvCommand command4 = (RgvCommand) task.getData();
+                        if (null == command4) {
+                            command4 = new RgvCommand();
+                        }
+                        command4.setRgvNo(slave.getId()); // RGV缂栧彿
+                        command4.setAckFinish2(true);  // 浠诲姟瀹屾垚纭浣�
+                        command4.setTaskStatus2(RgvTaskStatusType.NONE); // 浠诲姟妯″紡
+                        command4.setTargetPosition2( 0);     // 灏忚溅鐩爣绔欐竻闆�
+                        command4.setCommand(false);
+                        write2(command4);
+                        break;
                     // 鍥炲師鐐�  閬胯
                     case 9:
 //                        RgvCommand commandAvoidanceXY = (RgvCommand) task.getData();
diff --git a/src/main/resources/mapper/WrkMastStaMapper.xml b/src/main/resources/mapper/WrkMastStaMapper.xml
index 6997839..493ed89 100644
--- a/src/main/resources/mapper/WrkMastStaMapper.xml
+++ b/src/main/resources/mapper/WrkMastStaMapper.xml
@@ -74,6 +74,31 @@
         order by line_number,id
     </select>
 
+    <select id="selectNoInterfere" resultMap="BaseResultMap">
+        select * from asr_wrk_mast_sta
+        where 1=1
+        and (sta_start in
+        <foreach item="item" collection="staStarts" index="index" separator="," open="(" close=")">
+            #{item}
+        </foreach>
+        or sta_start = 0
+        )
+        and (sta_end in
+        <foreach item="item" collection="staEnds" index="index" separator="," open="(" close=")">
+            #{item}
+        </foreach>
+        or sta_end = 0
+        )
+        and wrk_sts=0
+        and wrk_no = #{workNo}
+        order by line_number,id
+    </select>
+    <select id="selectByWorkSta" resultMap="BaseResultMap">
+        select *
+        where work_sta = #{workSta}
+        and rgv_no = #{rgvNo}
+    </select>
+
     <select id="selectAllWrkCount" resultType="java.lang.Integer">
         select count(1) from asr_wrk_mast_sta
         where 1=1

--
Gitblit v1.9.1