From 29e8cbccfba7cd77026c724d093d6a82da99e5af Mon Sep 17 00:00:00 2001
From: luxiaotao1123 <t1341870251@163.com>
Date: 星期四, 22 九月 2022 13:55:09 +0800
Subject: [PATCH] #

---
 src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java | 1115 ++++++++++++++++++++++++++++++++++++++++++++++++----------
 1 files changed, 915 insertions(+), 200 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 ce0449c..be64108 100644
--- a/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java
+++ b/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java
@@ -8,7 +8,6 @@
 import com.core.exception.CoolException;
 import com.zy.asrs.entity.*;
 import com.zy.asrs.mapper.BasCrnErrorMapper;
-import com.zy.asrs.mapper.WaitPakinMapper;
 import com.zy.asrs.mapper.WrkMastMapper;
 import com.zy.asrs.service.*;
 import com.zy.asrs.utils.Utils;
@@ -34,6 +33,7 @@
 import com.zy.core.properties.SlaveProperties;
 import com.zy.core.thread.BarcodeThread;
 import com.zy.core.thread.LedThread;
+import com.zy.core.thread.SiemensDevpThread;
 import com.zy.core.thread.SteThread;
 import lombok.extern.slf4j.Slf4j;
 import org.springframework.beans.factory.annotation.Autowired;
@@ -58,18 +58,14 @@
 @Transactional
 public class MainServiceImpl {
 
-    public static final long COMMAND_TIMEOUT = 5 * 1000;
-
-    @Autowired
-    private CommonService commonService;
+    @Value("${wms.url}")
+    private String wmsUrl;
     @Autowired
     private SlaveProperties slaveProperties;
     @Autowired
     private WrkMastMapper wrkMastMapper;
     @Autowired
     private WrkDetlService wrkDetlService;
-    @Autowired
-    private WaitPakinMapper waitPakinMapper;
     @Autowired
     private LocMastService locMastService;
     @Autowired
@@ -79,15 +75,15 @@
     @Autowired
     private BasDevpService basDevpService;
     @Autowired
-    private LocDetlService locDetlService;
-    @Autowired
     private BasErrLogService basErrLogService;
     @Autowired
     private BasCrnErrorMapper basCrnErrorMapper;
     @Autowired
     private BasSteService basSteService;
-    @Value("${wms.url}")
-    private String wmsUrl;
+    @Autowired
+    private WrkChargeService wrkChargeService;
+    @Autowired
+    private CommonService commonService;
 
     /**
      * 缁勬墭
@@ -230,20 +226,6 @@
         for (DevpSlave devp : slaveProperties.getDevp()) {
             // 閬嶅巻鎷f枡鍏ュ簱鍙�
             for (DevpSlave.Sta pickSta : devp.getPickSta()) {
-                // 鑾峰彇鏉$爜鎵弿浠俊鎭�
-                BarcodeThread barcodeThread = (BarcodeThread) SlaveConnection.get(SlaveType.Barcode, pickSta.getBarcode());
-                if (barcodeThread == null) {
-                    continue;
-                }
-                String barcode = barcodeThread.getBarcode();
-                if(!Cools.isEmpty(barcode)) {
-                    log.info("{}鍙锋潯鐮佹壂鎻忓櫒妫�娴嬫潯鐮佷俊鎭細{}", pickSta.getBarcode(), barcode);
-                    if("NG".endsWith(barcode) || "NoRead".equals(barcode)) {
-                        continue;
-                    }
-                } else {
-                    continue;
-                }
 
                 // 鑾峰彇鎷f枡鍏ュ簱绔欎俊鎭�
                 DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, devp.getId());
@@ -254,6 +236,22 @@
                     staProtocol = staProtocol.clone();
                 }
                 if (staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.isInEnable() && staProtocol.isPakMk()){
+
+                    // 鑾峰彇鏉$爜鎵弿浠俊鎭�
+                    BarcodeThread barcodeThread = (BarcodeThread) SlaveConnection.get(SlaveType.Barcode, pickSta.getBarcode());
+                    if (barcodeThread == null) {
+                        continue;
+                    }
+                    String barcode = barcodeThread.getBarcode();
+                    if(!Cools.isEmpty(barcode)) {
+                        log.info("{}鍙锋潯鐮佹壂鎻忓櫒妫�娴嬫潯鐮佷俊鎭細{}", pickSta.getBarcode(), barcode);
+                        if("NG".endsWith(barcode) || "NoRead".equals(barcode)) {
+                            continue;
+                        }
+                    } else {
+                        continue;
+                    }
+
                     WrkMast wrkMast = wrkMastMapper.selectPickStep(barcode);
                     if (wrkMast == null) {
                         // 鏃犳嫞鏂欐暟鎹�
@@ -412,13 +410,13 @@
                     if (basCrnp.getInEnable().equals("Y")) {
                         //  鍏ュ簱
                         if (this.crnStnToLoc(crn, crnProtocol)) {
-                            crnProtocol.setLastIo("O");
                         }
+                        crnProtocol.setLastIo("O");
                     } else if (basCrnp.getOutEnable().equals("Y")) {
                         //  鍑哄簱
                         if (this.locToCrnStn(crn, crnProtocol)) {
-                            crnProtocol.setLastIo("I");
                         }
+                        crnProtocol.setLastIo("I");
                     }
                 }
                 // 濡傛灉鏈�杩戜竴娆℃槸鍑哄簱妯″紡
@@ -426,15 +424,17 @@
                     if (basCrnp.getOutEnable().equals("Y")) {
                         //  鍑哄簱
                         if (this.locToCrnStn(crn, crnProtocol)) {
-                            crnProtocol.setLastIo("I");
                         }
+                        crnProtocol.setLastIo("I");
                     } else if (basCrnp.getInEnable().equals("Y")) {
                         //  鍏ュ簱
                         if (this.crnStnToLoc(crn, crnProtocol)) {
-                            crnProtocol.setLastIo("O");
                         }
+                        crnProtocol.setLastIo("O");
                     }
                 }
+                // 搴撲綅绉昏浆
+                this.locToLoc(crn, crnProtocol);
             }
         }
     }
@@ -459,18 +459,20 @@
                 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;
-            }
             // 鑾峰彇宸ヤ綔鐘舵�佷负 2,3,4,5,6 鐨勫叆搴撳伐浣滄。
             WrkMast wrkMast = wrkMastMapper.selectPakInStep23456(slave.getId(), staProtocol.getWorkNo().intValue(), crnStn.getStaNo());
             if(null == wrkMast) {
-                log.error("{}绔欑偣鏌ヨ鏃犲緟鍏ュ簱鏁版嵁 宸ヤ綔鍙�={}", crnStn.getStaNo(), staProtocol.getWorkNo());
+//                log.error("{}绔欑偣鏌ヨ鏃犲緟鍏ュ簱鏁版嵁 宸ヤ綔鍙�={}", crnStn.getStaNo(), staProtocol.getWorkNo());
                 continue;
+            }
+            if (wrkMast.getWrkSts() < 3) {
+                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());
@@ -483,6 +485,10 @@
                 continue;
             }
 
+            // 缃《浠诲姟
+            wrkMast.setIoPri((double) 9999);
+            wrkMastMapper.updateById(wrkMast);
+
             // 鐩爣搴撲綅 ===>> 鏈�澶栧眰搴撲綅
             if (locMastService.isOutMost(wrkMast.getLocNo())) {
                 // 鍒ゆ柇灏忚溅鏄惁鍦ㄦ渶澶栧眰搴撲綅锛屽鏋滄槸鍒欐惉璧帮紝濡傛灉涓嶆槸锛屽垯鐩存帴鍫嗗灈鏈哄叆搴�
@@ -490,8 +496,8 @@
                 // 鏈夊皬杞�
                 if (steNo != null) {
                     // 灏忚溅琛岃蛋鍒板爢鍨涙満寰呮惉绉荤偣
-                    if (wrkMast.getWrkSts() == 2L && wrkMast.getStaNo() == null) {
-                        this.letCarBeReady(wrkMast, steNo);
+                    if (wrkMast.getWrkSts() == 2L && wrkMast.getSteNo() == null) {
+                        this.letCarBeReady(wrkMast, steNo, wrkMast.getLocNo());
                     }
                     // 灏忚溅鎼蛋
                     if (wrkMast.getWrkSts() == 3L) {
@@ -503,7 +509,7 @@
                     // 褰撳墠鍏ュ簱搴撲綅缁勬病鏈夊皬杞� 鍫嗗灈鏈哄垯鍘荤珯鐐瑰彇璐у叆搴�
                     // case 1锛氫粠濮嬭嚦缁堝簱浣嶇粍閮芥病鏈夊皬杞︼紝娌℃湁杩佸嚭灏忚溅鍔ㄤ綔锛屾墍浠ュ伐浣滅姸鎬� = 2
                     // case 2锛氬爢鍨涙満宸茬粡鎼嚭灏忚溅锛屾湁杩佸嚭灏忚溅鍔ㄤ綔锛屾墍浠ュ伐浣滅姸鎬� = 6
-                    if (wrkMast.getWrkSts() == 2L || wrkMast.getWrkSts() == 6L) {
+                    if ((wrkMast.getWrkSts() == 2L && wrkMast.getSteNo() == null) || wrkMast.getWrkSts() == 6L) {
 
                         // 宸茬粡瀛樺湪鍚婅溅鎵ц浠诲姟鏃讹紝鍒欒繃婊�
                         if (wrkMastMapper.selectWorking(slave.getId()) != null) {
@@ -546,8 +552,8 @@
                 // 鏈夊皬杞�
                 if (steNo != null) {
                     // 灏忚溅琛岃蛋鍒板爢鍨涙満寰呮惉绉荤偣
-                    if (wrkMast.getWrkSts() == 2L && wrkMast.getStaNo() == null) {
-                        this.letCarBeReady(wrkMast, steNo);
+                    if (wrkMast.getWrkSts() == 2L && wrkMast.getSteNo() == null) {
+                        this.letCarBeWaiting(wrkMast, steNo, wrkMast.getLocNo());
                     }
                     // 鍫嗗灈鏈哄皢璐ф斁鑷冲皬杞︿笂 3.灏忚溅寰呮惉锛堝皬杞︿笉鐢ㄦ惉杩愶紝宸茬粡鍦ㄥ綋鍓嶇粍搴撲綅锛� / 6.灏忚溅寰呭叆  ===>> 7.鍚婅溅鍏ュ簱涓�
                     if (wrkMast.getWrkSts() == 3L || wrkMast.getWrkSts() == 6L) {
@@ -555,7 +561,7 @@
                         SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, steNo);
                         SteProtocol steProtocol = steThread.getSteProtocol();
                         if (steProtocol == null) { continue; }
-                        if (steProtocol.getStatusType().equals(SteStatusType.IDLE)) {
+                        if (steProtocol.isIdle()) {
 
                             // 宸茬粡瀛樺湪鍚婅溅鎵ц浠诲姟鏃讹紝鍒欒繃婊�
                             if (wrkMastMapper.selectWorking(slave.getId()) != null) {
@@ -590,12 +596,12 @@
                     }
                 // 娌℃湁灏忚溅
                 } else {
-                    if (wrkMast.getWrkSts() == 2L && wrkMast.getStaNo() == null) {
+                    if (wrkMast.getWrkSts() == 2L && wrkMast.getSteNo() == null) {
                         // 瀵绘壘褰撳墠鍫嗗灈鏈哄搴旂殑灏忚溅
                         SteThread steThread = queryIdleCar(wrkMast);
                         if (steThread != null) {
                             // 璁╁皬杞︾瓑寰呮惉杩愬緟缁�
-                            this.letCarBeReady(wrkMast, steThread.getSlave().getId());
+                            this.letCarBeReady(wrkMast, steThread.getSlave().getId(), wrkMast.getLocNo());
                         }
                     }
                     // 鍫嗗灈鏈烘惉杩愬皬杞�
@@ -615,7 +621,7 @@
     public boolean locToCrnStn(CrnSlave slave, CrnProtocol crnProtocol){
         for (CrnSlave.CrnStn crnStn : slave.getCrnOutStn()) {
             // 鑾峰彇宸ヤ綔鐘舵�佷负11锛堢敓鎴愬嚭搴揑D锛夌殑鍑哄簱宸ヤ綔妗�
-            WrkMast wrkMast = wrkMastMapper.selectPakOutStep11(slave.getId(), crnStn.getStaNo());
+            WrkMast wrkMast = wrkMastMapper.selectPakOutStep111215(slave.getId(), crnStn.getStaNo());
             if (wrkMast == null) {
                 continue;
             }
@@ -654,6 +660,10 @@
                     continue;
                 }
 
+                // 缃《浠诲姟
+                wrkMast.setIoPri((double) 9999);
+                wrkMastMapper.updateById(wrkMast);
+
                 // 鏈�澶栧眰搴撲綅锛岀洿鎺ュ爢鍨涙満鍑哄簱
                 if (locMastService.isOutMost(wrkMast.getSourceLocNo())) {
                     // 宸茬粡瀛樺湪鍚婅溅鎵ц浠诲姟鏃讹紝鍒欒繃婊�
@@ -686,10 +696,10 @@
                         }
                         return true;
                     }
-                    // 涓嶆槸鏈�澶栧眰搴撲綅锛岄渶瑕佷娇鐢ㄧ┛姊溅鎼繍鍚庯紝鍐嶅爢鍨涙満鍑哄簱
+                // 涓嶆槸鏈�澶栧眰搴撲綅锛岄渶瑕佷娇鐢ㄧ┛姊溅鎼繍鍚庯紝鍐嶅爢鍨涙満鍑哄簱
                 } else {
                     // 褰撳墠缁勫簱浣嶆槸鍚︽湁绌挎杞�
-                    Integer steNo = this.hasCarOfIdle(wrkMast.getLocNo());
+                    Integer steNo = this.hasCarOfIdle(wrkMast.getSourceLocNo());
                     // 鏈夊皬杞�
                     if (steNo != null) {
                         if (wrkMast.getWrkSts() == 11L && wrkMast.getSteNo() == null) {
@@ -698,14 +708,18 @@
                             SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, steNo);
                             SteProtocol steProtocol = steThread.getSteProtocol();
                             if (steProtocol == null) { continue; }
-                            if (steProtocol.getStatusType().equals(SteStatusType.IDLE)) {
+                            if (steProtocol.isIdle()) {
 
                                 // 鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
                                 SteCommand steCommand = new SteCommand();
                                 steCommand.setSteNo(steNo); // 绌挎杞︾紪鍙�
                                 steCommand.setTaskNo(wrkMast.getWrkNo()); // 宸ヤ綔鍙�
-                                steCommand.setTaskMode(SteTaskModeType.TO_B); // 浠诲姟妯″紡:  鍘昏繎鐐� 绛夊緟鍫嗗灈鏈哄弶鍙�
-                                // todo:luxiaotao
+                                steCommand.setTaskMode(SteTaskModeType.findOutByLoc(wrkMast.getSourceLocNo())); // 浠诲姟妯″紡:  鍘昏繎鐐� 绛夊緟鍫嗗灈鏈哄弶鍙�
+
+                                steCommand.setRow(Utils.getGroupRow(steProtocol.getRow().intValue()).shortValue());
+                                steCommand.setBay(steProtocol.getBay());
+                                steCommand.setLev(steProtocol.getLev());
+
                                 if (!MessageQueue.offer(SlaveType.Ste, steNo, new Task(2, steCommand))) {
                                     log.error("绌挎杞﹀懡浠や笅鍙戝け璐ワ紝绌挎杞﹀彿={}锛屼换鍔℃暟鎹�={}", steNo, JSON.toJSON(steCommand));
                                 } else {
@@ -733,7 +747,7 @@
                             crnCommand.setTaskNo(wrkMast.getWrkNo().shortValue()); // 宸ヤ綔鍙�
                             crnCommand.setAckFinish((short) 0);  // 浠诲姟瀹屾垚纭浣�
                             crnCommand.setTaskMode(CrnTaskModeType.LOC_MOVE); // 浠诲姟妯″紡:  搴撲綅绉昏浆
-                            crnCommand.setSourcePosX(sourceSta.getRow1().shortValue());     // 婧愬簱浣嶆帓
+                            crnCommand.setSourcePosX(Utils.getGroupRow(sourceSta.getRow1()).shortValue());     // 婧愬簱浣嶆帓
                             crnCommand.setSourcePosY(sourceSta.getBay1().shortValue());     // 婧愬簱浣嶅垪
                             crnCommand.setSourcePosZ(sourceSta.getLev1().shortValue());     // 婧愬簱浣嶅眰
                             crnCommand.setDestinationPosX(crnStn.getRow().shortValue());     // 鐩爣搴撲綅鎺�
@@ -754,14 +768,14 @@
                             }
                         }
 
-                        // 娌℃湁灏忚溅
+                    // 娌℃湁灏忚溅
                     } else {
-                        if (wrkMast.getWrkSts() == 11L && wrkMast.getStaNo() == null) {
+                        if (wrkMast.getWrkSts() == 11L && wrkMast.getSteNo() == null) {
                             // 瀵绘壘鏈�杩戠殑灏忚溅
                             SteThread steThread = queryIdleCar(wrkMast);
                             if (steThread != null) {
                                 // 璁╁皬杞︾瓑寰呮惉杩愬緟缁�
-                                this.letCarBeReady(wrkMast, steThread.getSlave().getId());
+                                this.letCarBeReady(wrkMast, steThread.getSlave().getId(), wrkMast.getSourceLocNo());
                             }
                         }
                         // 鍫嗗灈鏈烘惉杩愬皬杞�
@@ -777,6 +791,291 @@
     }
 
     /**
+     * 搴撲綅绉昏浆
+     */
+    public void locToLoc(CrnSlave slave, CrnProtocol crnProtocol){
+        // 鑾峰彇宸ヤ綔妗d俊鎭�
+        WrkMast wrkMast = wrkMastMapper.selectLocMove(slave.getId());
+        if (null == wrkMast) {
+            return;
+        }
+        // 鑾峰彇婧愬簱浣嶄俊鎭�
+        LocMast sourceLoc = locMastService.selectById(wrkMast.getSourceLocNo());
+        if (null == sourceLoc) {
+            log.error("宸ヤ綔妗e簱浣嶇Щ杞け璐ワ紝鍘熷洜锛氭绱㈡簮搴撲綅澶辫触锛佸伐浣滃彿={}锛屾簮搴撲綅={}", wrkMast.getWrkNo(), wrkMast.getSourceLocNo());
+            return;
+        }
+        // 婧愬簱浣�  搴撲綅鐘舵�佸垽鏂�
+        if (!sourceLoc.getLocSts().equals("R") && !sourceLoc.getLocSts().equals("S")) {
+            return;
+        }
+        // 鑾峰彇鐩爣搴撲綅淇℃伅
+        LocMast loc = locMastService.selectById(wrkMast.getLocNo());
+        if (null == loc) {
+            log.error("宸ヤ綔妗e簱浣嶇Щ杞け璐ワ紝鍘熷洜锛氭绱㈢洰鏍囧簱浣嶅け璐ワ紒宸ヤ綔鍙�={}锛屾簮搴撲綅={}", wrkMast.getWrkNo(), wrkMast.getLocNo());
+            return;
+        }
+        // 鑾峰彇鍫嗗灈鏈轰俊鎭� 骞� 鍒ゆ柇鏄惁鍙叆鍑�
+        BasCrnp basCrnp = basCrnpService.selectById(slave.getId());
+        if (!basCrnp.getInEnable().equals("Y") && !basCrnp.getOutEnable().equals("Y")) {
+            return;
+        }
+
+        // 鍫嗗灈鏈烘帶鍒惰繃婊�
+        if (!crnProtocol.getStatusType().equals(CrnStatusType.IDLE) || crnProtocol.getTaskNo() != 0) {
+            return;
+        }
+
+        // 宸茬粡瀛樺湪鍚婅溅鎵ц浠诲姟鏃讹紝鍒欒繃婊�
+        if (wrkMastMapper.selectWorking(slave.getId()) != null) {
+            return;
+        }
+
+        // 缃《浠诲姟
+        wrkMast.setIoPri((double) 9999);
+        wrkMastMapper.updateById(wrkMast);
+
+        // 婧愬簱浣� ===>> 鏈�澶栧眰搴撲綅
+        if (locMastService.isOutMost(wrkMast.getSourceLocNo())) {
+            // 鐩爣搴撲綅 ===>> 鏈�澶栧眰搴撲綅
+            if (locMastService.isOutMost(wrkMast.getLocNo())) {
+                // 鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
+                CrnCommand crnCommand = new CrnCommand();
+                crnCommand.setCrnNo(slave.getId()); // 鍫嗗灈鏈虹紪鍙�
+                crnCommand.setTaskNo(wrkMast.getWrkNo().shortValue()); // 宸ヤ綔鍙�
+                crnCommand.setAckFinish((short) 0);  // 浠诲姟瀹屾垚纭浣�
+                crnCommand.setTaskMode(CrnTaskModeType.LOC_MOVE); // 浠诲姟妯″紡:  搴撲綅绉昏浆
+                crnCommand.setSourcePosX(sourceLoc.getRow1().shortValue());     // 婧愬簱浣嶆帓
+                crnCommand.setSourcePosY(sourceLoc.getBay1().shortValue());     // 婧愬簱浣嶅垪
+                crnCommand.setSourcePosZ(sourceLoc.getLev1().shortValue());     // 婧愬簱浣嶅眰
+                crnCommand.setDestinationPosX(loc.getRow1().shortValue());     // 鐩爣搴撲綅鎺�
+                crnCommand.setDestinationPosY(loc.getBay1().shortValue());     // 鐩爣搴撲綅鍒�
+                crnCommand.setDestinationPosZ(loc.getLev1().shortValue());     // 鐩爣搴撲綅灞�
+                if (!MessageQueue.offer(SlaveType.Crn, wrkMast.getCrnNo(), new Task(2, crnCommand))) {
+                    log.error("鍫嗗灈鏈哄懡浠や笅鍙戝け璐ワ紝鍫嗗灈鏈哄彿={}锛屼换鍔℃暟鎹�={}", wrkMast.getCrnNo(), JSON.toJSON(crnCommand));
+                } else {
+                    // 淇敼宸ヤ綔妗g姸鎬� 11.鐢熸垚鍑哄簱ID => 16.鍚婅溅鍑哄簱涓�
+                    Date now = new Date();
+                    wrkMast.setWrkSts(16L);
+                    wrkMast.setCrnStrTime(now);
+                    wrkMast.setModiTime(now);
+                    if (wrkMastMapper.updateById(wrkMast) == 0) {
+                        log.error("銆愬簱浣嶇Щ杞�� 淇敼宸ヤ綔妗g姸鎬� 11.鐢熸垚鍑哄簱ID => 12.鍚婅溅鍑哄簱涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
+                    }
+                }
+            } else {
+                Integer steNo = this.hasCarOfIdle(wrkMast.getLocNo());
+                // 鏈夊皬杞�
+                if (steNo != null) {
+                    // 灏忚溅琛岃蛋鍒板爢鍨涙満寰呮惉绉荤偣
+                    if (wrkMast.getWrkSts() == 11L && wrkMast.getSteNo() == null) {
+                        this.letCarBeWaiting(wrkMast, steNo, wrkMast.getLocNo());
+                    }
+                    // 鍫嗗灈鏈哄皢璐ф斁鑷冲皬杞︿笂 6.灏忚溅寰呭叆  ===>> 7.鍚婅溅鍏ュ簱涓�
+                    if (wrkMast.getWrkSts() == 6L) {
+                        // 灏忚溅澶勪簬绌洪棽
+                        SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, steNo);
+                        SteProtocol steProtocol = steThread.getSteProtocol();
+                        if (steProtocol == null) { return; }
+                        if (steProtocol.isIdle()) {
+
+                            // 宸茬粡瀛樺湪鍚婅溅鎵ц浠诲姟鏃讹紝鍒欒繃婊�
+                            if (wrkMastMapper.selectWorking(slave.getId()) != null) {
+                                return;
+                            }
+                            // 鍫嗗灈鏈哄叆搴� 鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
+                            CrnCommand crnCommand = new CrnCommand();
+                            crnCommand.setCrnNo(slave.getId()); // 鍫嗗灈鏈虹紪鍙�
+                            crnCommand.setTaskNo(wrkMast.getWrkNo().shortValue()); // 宸ヤ綔鍙�
+                            crnCommand.setAckFinish((short) 0);  // 浠诲姟瀹屾垚纭浣�
+                            crnCommand.setTaskMode(CrnTaskModeType.LOC_MOVE); // 浠诲姟妯″紡:  搴撲綅绉昏浆
+                            crnCommand.setSourcePosX(Utils.getGroupRow(sourceLoc.getRow1()).shortValue());     // 婧愬簱浣嶆帓
+                            crnCommand.setSourcePosY(sourceLoc.getBay1().shortValue());     // 婧愬簱浣嶅垪
+                            crnCommand.setSourcePosZ(sourceLoc.getLev1().shortValue());     // 婧愬簱浣嶅眰
+                            crnCommand.setDestinationPosX(Utils.getGroupRow(loc.getRow1()).shortValue());     // 鐩爣搴撲綅鎺�
+                            crnCommand.setDestinationPosY(loc.getBay1().shortValue());     // 鐩爣搴撲綅鍒�
+                            crnCommand.setDestinationPosZ(loc.getLev1().shortValue());     // 鐩爣搴撲綅灞�
+                            if (!MessageQueue.offer(SlaveType.Crn, wrkMast.getCrnNo(), new Task(2, crnCommand))) {
+                                log.error("鍫嗗灈鏈哄懡浠や笅鍙戝け璐ワ紝鍫嗗灈鏈哄彿={}锛屼换鍔℃暟鎹�={}", wrkMast.getCrnNo(), JSON.toJSON(crnCommand));
+                            } else {
+                                // 淇敼宸ヤ綔妗g姸鎬�  6.灏忚溅寰呭叆 ===>> 7.鍚婅溅鍏ュ簱涓�
+                                Date now = new Date();
+                                wrkMast.setWrkSts(7L);
+                                wrkMast.setCrnStrTime(now);
+                                wrkMast.setModiTime(now);
+                                if (wrkMastMapper.updateById(wrkMast) == 0) {
+                                    log.error("淇敼宸ヤ綔妗g姸鎬� 3.灏忚溅寰呮惉/6.灏忚溅寰呭叆 => 7.鍚婅溅鍏ュ簱涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
+                                }
+                            }
+                        }
+                    }
+                } else {
+                    if (wrkMast.getWrkSts() == 11L && wrkMast.getSteNo() == null) {
+                        // 瀵绘壘褰撳墠鍫嗗灈鏈哄搴旂殑灏忚溅
+                        SteThread steThread = queryIdleCar(wrkMast);
+                        if (steThread != null) {
+                            // 鏍囪绉诲簱褰撳墠娴佺▼
+                            wrkMast.setMk("I");
+                            if (wrkMastMapper.updateById(wrkMast) == 0) {
+                                log.error("鏍囪绉诲簱褰撳墠娴佺▼ I 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
+                            }
+                            // 璁╁皬杞︾瓑寰呮惉杩愬緟缁�
+                            this.letCarBeReady(wrkMast, steThread.getSlave().getId(), wrkMast.getLocNo());
+                        }
+                    }
+                    // 鍫嗗灈鏈烘惉杩愬皬杞�
+                    if (wrkMast.getWrkSts() == 3L) {
+                        this.carMoveIn(wrkMast, wrkMast.getSteNo(), crnProtocol);
+                    }
+                }
+            }
+
+        } else {
+
+            // 褰撳墠缁勫簱浣嶆槸鍚︽湁绌挎杞�
+            Integer steNo = this.hasCarOfIdle(wrkMast.getSourceLocNo());
+            // 鏈夊皬杞�
+            if (steNo != null) {
+                if (wrkMast.getWrkSts() == 11L && wrkMast.getSteNo() == null) {
+
+                    // 缁欑┛姊溅涓嬪彂鍛戒护 璁╁叾灏嗚揣鐗╂尓鑷冲爢鍨涙満鎼繍鐐�
+                    SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, steNo);
+                    SteProtocol steProtocol = steThread.getSteProtocol();
+                    if (steProtocol == null) { return; }
+                    if (steProtocol.isIdle()) {
+
+                        // 鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
+                        SteCommand steCommand = new SteCommand();
+                        steCommand.setSteNo(steNo); // 绌挎杞︾紪鍙�
+                        steCommand.setTaskNo(wrkMast.getWrkNo()); // 宸ヤ綔鍙�
+                        steCommand.setTaskMode(SteTaskModeType.findOutByLoc(wrkMast.getSourceLocNo())); // 浠诲姟妯″紡:  鍘昏繎鐐� 绛夊緟鍫嗗灈鏈哄弶鍙�
+
+                        steCommand.setRow(Utils.getGroupRow(steProtocol.getRow().intValue()).shortValue());
+                        steCommand.setBay(steProtocol.getBay());
+                        steCommand.setLev(steProtocol.getLev());
+
+                        if (!MessageQueue.offer(SlaveType.Ste, steNo, new Task(2, steCommand))) {
+                            log.error("绌挎杞﹀懡浠や笅鍙戝け璐ワ紝绌挎杞﹀彿={}锛屼换鍔℃暟鎹�={}", steNo, JSON.toJSON(steCommand));
+                        } else {
+                            // 淇敼宸ヤ綔妗g姸鎬� 11.鐢熸垚鍑哄簱ID => 14.灏忚溅鎼嚭搴�
+                            Date now = new Date();
+                            wrkMast.setWrkSts(14L);
+                            wrkMast.setSteNo(steNo);
+                            wrkMast.setCrnStrTime(now);
+                            wrkMast.setModiTime(now);
+                            if (wrkMastMapper.updateById(wrkMast) == 0) {
+                                log.error("淇敼宸ヤ綔妗g姸鎬� 11.鐢熸垚鍑哄簱ID => 14.灏忚溅鎼嚭搴� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
+                            }
+                        }
+                    }
+                }
+                if (wrkMast.getWrkSts() == 15L) {
+                    // 宸茬粡瀛樺湪鍚婅溅鎵ц浠诲姟鏃讹紝鍒欒繃婊�
+                    if (wrkMastMapper.selectWorking(slave.getId()) != null) {
+                        return;
+                    }
+
+                    // 鐩爣搴撲綅 ===>> 鏈�澶栧眰搴撲綅
+                    if (locMastService.isOutMost(wrkMast.getLocNo())) {
+                        // 鍫嗗灈鏈哄嚭搴� 鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
+                        CrnCommand crnCommand = new CrnCommand();
+                        crnCommand.setCrnNo(slave.getId()); // 鍫嗗灈鏈虹紪鍙�
+                        crnCommand.setTaskNo(wrkMast.getWrkNo().shortValue()); // 宸ヤ綔鍙�
+                        crnCommand.setAckFinish((short) 0);  // 浠诲姟瀹屾垚纭浣�
+                        crnCommand.setTaskMode(CrnTaskModeType.LOC_MOVE); // 浠诲姟妯″紡:  搴撲綅绉昏浆
+                        crnCommand.setSourcePosX(Utils.getGroupRow(sourceLoc.getRow1()).shortValue());     // 婧愬簱浣嶆帓
+                        crnCommand.setSourcePosY(sourceLoc.getBay1().shortValue());     // 婧愬簱浣嶅垪
+                        crnCommand.setSourcePosZ(sourceLoc.getLev1().shortValue());     // 婧愬簱浣嶅眰
+                        crnCommand.setDestinationPosX(Utils.getGroupRow(loc.getRow1()).shortValue());     // 鐩爣搴撲綅鎺�
+                        crnCommand.setDestinationPosY(loc.getBay1().shortValue());     // 鐩爣搴撲綅鍒�
+                        crnCommand.setDestinationPosZ(loc.getLev1().shortValue());     // 鐩爣搴撲綅灞�
+                        if (!MessageQueue.offer(SlaveType.Crn, wrkMast.getCrnNo(), new Task(2, crnCommand))) {
+                            log.error("鍫嗗灈鏈哄懡浠や笅鍙戝け璐ワ紝鍫嗗灈鏈哄彿={}锛屼换鍔℃暟鎹�={}", wrkMast.getCrnNo(), JSON.toJSON(crnCommand));
+                        } else {
+                            // 淇敼宸ヤ綔妗g姸鎬� 15.绛夊緟鍚婅溅 => 16.鍚婅溅鍑哄簱涓�
+                            Date now = new Date();
+                            wrkMast.setWrkSts(16L);
+                            wrkMast.setCrnStrTime(now);
+                            wrkMast.setModiTime(now);
+                            if (wrkMastMapper.updateById(wrkMast) == 0) {
+                                log.error("淇敼宸ヤ綔妗g姸鎬� 15.绛夊緟鍚婅溅 => 16.鍚婅溅鍑哄簱涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
+                            }
+                            wrkMastMapper.setSteEmpty(wrkMast.getWrkNo());
+                        }
+                    } else {
+
+                        // 鎶婅揣鎼埌涓存椂瀛樻斁璐т綅 todo:luxiaotao
+
+
+                        // 灏忚溅琛岃蛋鍒板爢鍨涙満寰呮惉绉荤偣
+                        if (wrkMast.getWrkSts() == 11L && wrkMast.getSteNo() == null) {
+                            this.letCarBeWaiting(wrkMast, steNo, wrkMast.getLocNo());
+                        }
+                        // 鍫嗗灈鏈哄皢璐ф斁鑷冲皬杞︿笂 6.灏忚溅寰呭叆  ===>> 7.鍚婅溅鍏ュ簱涓�
+                        if (wrkMast.getWrkSts() == 6L) {
+                            // 灏忚溅澶勪簬绌洪棽
+                            SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, steNo);
+                            SteProtocol steProtocol = steThread.getSteProtocol();
+                            if (steProtocol == null) { return; }
+                            if (steProtocol.isIdle()) {
+
+                                // 宸茬粡瀛樺湪鍚婅溅鎵ц浠诲姟鏃讹紝鍒欒繃婊�
+                                if (wrkMastMapper.selectWorking(slave.getId()) != null) {
+                                    return;
+                                }
+                                // 鍫嗗灈鏈哄叆搴� 鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
+                                CrnCommand crnCommand = new CrnCommand();
+                                crnCommand.setCrnNo(slave.getId()); // 鍫嗗灈鏈虹紪鍙�
+                                crnCommand.setTaskNo(wrkMast.getWrkNo().shortValue()); // 宸ヤ綔鍙�
+                                crnCommand.setAckFinish((short) 0);  // 浠诲姟瀹屾垚纭浣�
+                                crnCommand.setTaskMode(CrnTaskModeType.LOC_MOVE); // 浠诲姟妯″紡:  搴撲綅绉昏浆
+                                crnCommand.setSourcePosX(Utils.getGroupRow(sourceLoc.getRow1()).shortValue());     // 婧愬簱浣嶆帓
+                                crnCommand.setSourcePosY(sourceLoc.getBay1().shortValue());     // 婧愬簱浣嶅垪
+                                crnCommand.setSourcePosZ(sourceLoc.getLev1().shortValue());     // 婧愬簱浣嶅眰
+                                crnCommand.setDestinationPosX(Utils.getGroupRow(loc.getRow1()).shortValue());     // 鐩爣搴撲綅鎺�
+                                crnCommand.setDestinationPosY(loc.getBay1().shortValue());     // 鐩爣搴撲綅鍒�
+                                crnCommand.setDestinationPosZ(loc.getLev1().shortValue());     // 鐩爣搴撲綅灞�
+                                if (!MessageQueue.offer(SlaveType.Crn, wrkMast.getCrnNo(), new Task(2, crnCommand))) {
+                                    log.error("鍫嗗灈鏈哄懡浠や笅鍙戝け璐ワ紝鍫嗗灈鏈哄彿={}锛屼换鍔℃暟鎹�={}", wrkMast.getCrnNo(), JSON.toJSON(crnCommand));
+                                } else {
+                                    // 淇敼宸ヤ綔妗g姸鎬�  6.灏忚溅寰呭叆 ===>> 7.鍚婅溅鍏ュ簱涓�
+                                    Date now = new Date();
+                                    wrkMast.setWrkSts(7L);
+                                    wrkMast.setCrnStrTime(now);
+                                    wrkMast.setModiTime(now);
+                                    if (wrkMastMapper.updateById(wrkMast) == 0) {
+                                        log.error("淇敼宸ヤ綔妗g姸鎬� 3.灏忚溅寰呮惉/6.灏忚溅寰呭叆 => 7.鍚婅溅鍏ュ簱涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
+                                    }
+                                }
+                            }
+                        }
+
+                    }
+
+                }
+            } else {
+                if (wrkMast.getWrkSts() == 11L && wrkMast.getSteNo() == null) {
+                    // 瀵绘壘鏈�杩戠殑灏忚溅
+                    SteThread steThread = queryIdleCar(wrkMast);
+                    if (steThread != null) {
+                        // 鏍囪绉诲簱褰撳墠娴佺▼
+                        wrkMast.setMk("O");
+                        if (wrkMastMapper.updateById(wrkMast) == 0) {
+                            log.error("鏍囪绉诲簱褰撳墠娴佺▼ I 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
+                        }
+                        // 璁╁皬杞︾瓑寰呮惉杩愬緟缁�
+                        this.letCarBeReady(wrkMast, steThread.getSlave().getId(), wrkMast.getSourceLocNo());
+                    }
+                }
+                // 鍫嗗灈鏈烘惉杩愬皬杞�
+                if (wrkMast.getWrkSts() == 12L) {
+                    this.carMoveIn(wrkMast, wrkMast.getSteNo(), crnProtocol);
+                }
+            }
+        }
+    }
+
+    /**
      * 褰撳墠搴撲綅缁勬槸鍚﹀瓨鍦ㄧ┖闂插皬杞�
      */
     public Integer hasCarOfIdle(String locNo) {
@@ -785,7 +1084,7 @@
             SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, ste.getId());
             SteProtocol steProtocol = steThread.getSteProtocol();
             if (steProtocol == null) { continue; }
-            if (steProtocol.getStatusType().equals(SteStatusType.IDLE)) {
+            if (steProtocol.isIdle()) {
                 if (Utils.getGroupRow(locNo).equals(Utils.getGroupRow(steProtocol.getRow().intValue())) && steProtocol.getBay() == Utils.getBay(locNo) && steProtocol.getLev() == Utils.getLev(locNo)) {
                     return steProtocol.getSteNo().intValue();
                 }
@@ -804,7 +1103,7 @@
         SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, basSte.getSteNo());
         SteProtocol steProtocol = steThread.getSteProtocol();
         if (steProtocol != null) {
-            if (steProtocol.getStatusType().equals(SteStatusType.IDLE)) {
+            if (steProtocol.isIdle()) {
                 return steThread;
             }
         }
@@ -812,21 +1111,93 @@
     }
 
     /**
-     * 璁╁皬杞︿粠 杩滅偣 ====>> 绉诲姩鍒拌繎鐐�
+     * 璁╁皬杞︿粠 杩滅偣 ====>> 寰呮満
      *  绛夊緟鍫嗗灈鏈烘惉杩�
      */
-    public void letCarBeReady(WrkMast wrkMast, Integer steNo) {
+    public void letCarBeWaiting(WrkMast wrkMast, Integer steNo, String locNo) {
         // 鑾峰彇绌挎杞︿俊鎭�
         SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, steNo);
         SteProtocol steProtocol = steThread.getSteProtocol();
         if (steProtocol == null) { return; }
-        if (steProtocol.getStatusType().equals(SteStatusType.IDLE)) {
+        if (steProtocol.isIdle()) {
 
             // 鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
             SteCommand steCommand = new SteCommand();
             steCommand.setSteNo(steNo); // 绌挎杞︾紪鍙�
             steCommand.setTaskNo(wrkMast.getWrkNo()); // 宸ヤ綔鍙�
-            steCommand.setTaskMode(SteTaskModeType.TO_B); // 浠诲姟妯″紡:  鍘昏繎鐐� 绛夊緟鍫嗗灈鏈哄弶鍙�
+            steCommand.setTaskMode(SteTaskModeType.findWaiting(steProtocol.getRow().intValue())); // 浠诲姟妯″紡:  鍘昏繎鐐� 绛夊緟鍫嗗灈鏈哄弶鍙�
+
+            steCommand.setRow(Utils.getGroupRow(steProtocol.getRow().intValue()).shortValue());
+            steCommand.setBay(steProtocol.getBay());
+            steCommand.setLev(steProtocol.getLev());
+
+            if (!MessageQueue.offer(SlaveType.Ste, steNo, new Task(2, steCommand))) {
+                log.error("绌挎杞﹀懡浠や笅鍙戝け璐ワ紝绌挎杞﹀彿={}锛屼换鍔℃暟鎹�={}", steNo, JSON.toJSON(steCommand));
+            } else {
+                // 淇敼宸ヤ綔妗g姸鎬� 缁戝畾绌挎杞�
+                wrkMast.setSteNo(steNo);
+                wrkMast.setModiTime(new Date());
+                if (wrkMastMapper.updateById(wrkMast) == 0) {
+                    log.error("淇敼宸ヤ綔妗g姸鎬� 缁戝畾绌挎杞� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
+                }
+            }
+        }
+    }
+
+    public void letCarBeWaiting(WrkCharge wrkCharge, Integer steNo) {
+        // 鑾峰彇绌挎杞︿俊鎭�
+        SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, steNo);
+        SteProtocol steProtocol = steThread.getSteProtocol();
+        if (steProtocol == null) { return; }
+
+        if (!basSteService.updatePakMk(steNo, "Y")) {
+            log.error("淇敼绌挎杞︿綔涓氱姸鎬� 澶辫触锛侊紒锛岀┛姊溅={}", steNo);
+            return;
+        }
+
+        // 鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
+        SteCommand steCommand = new SteCommand();
+        steCommand.setSteNo(steNo); // 绌挎杞︾紪鍙�
+        steCommand.setTaskNo(wrkCharge.getWrkNo()); // 宸ヤ綔鍙�
+        steCommand.setTaskMode(SteTaskModeType.findOriginByLoc(steProtocol.getRow())); // 浠诲姟妯″紡:  鍘昏繎鐐� 绛夊緟鍫嗗灈鏈哄弶鍙�
+
+        steCommand.setRow(Utils.getGroupRow(steProtocol.getRow().intValue()).shortValue());
+        steCommand.setBay(steProtocol.getBay());
+        steCommand.setLev(steProtocol.getLev());
+
+        if (!MessageQueue.offer(SlaveType.Ste, steNo, new Task(2, steCommand))) {
+            log.error("绌挎杞﹀懡浠や笅鍙戝け璐ワ紝绌挎杞﹀彿={}锛屼换鍔℃暟鎹�={}", steNo, JSON.toJSON(steCommand));
+        } else {
+            // 淇敼宸ヤ綔妗g姸鎬� 缁戝畾绌挎杞�
+            wrkCharge.setSteNo(steNo);
+            wrkCharge.setModiTime(new Date());
+            if (!wrkChargeService.updateById(wrkCharge)) {
+                log.error("淇敼宸ヤ綔妗g姸鎬� 缁戝畾绌挎杞� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkCharge.getWrkNo());
+            }
+        }
+    }
+
+    /**
+     * 璁╁皬杞︿粠 杩滅偣 ====>> 绉诲姩鍒拌繎鐐�
+     *  绛夊緟鍫嗗灈鏈烘惉杩�
+     */
+    public void letCarBeReady(WrkMast wrkMast, Integer steNo, String locNo) {
+        // 鑾峰彇绌挎杞︿俊鎭�
+        SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, steNo);
+        SteProtocol steProtocol = steThread.getSteProtocol();
+        if (steProtocol == null) { return; }
+        if (steProtocol.isIdle()) {
+
+            // 鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
+            SteCommand steCommand = new SteCommand();
+            steCommand.setSteNo(steNo); // 绌挎杞︾紪鍙�
+            steCommand.setTaskNo(wrkMast.getWrkNo()); // 宸ヤ綔鍙�
+            steCommand.setTaskMode(SteTaskModeType.findOriginByLoc(steProtocol)); // 浠诲姟妯″紡:  鍘昏繎鐐� 绛夊緟鍫嗗灈鏈哄弶鍙�
+
+            steCommand.setRow(Utils.getGroupRow(steProtocol.getRow().intValue()).shortValue());
+            steCommand.setBay(steProtocol.getBay());
+            steCommand.setLev(steProtocol.getLev());
+
             if (!MessageQueue.offer(SlaveType.Ste, steNo, new Task(2, steCommand))) {
                 log.error("绌挎杞﹀懡浠や笅鍙戝け璐ワ紝绌挎杞﹀彿={}锛屼换鍔℃暟鎹�={}", steNo, JSON.toJSON(steCommand));
             } else {
@@ -848,7 +1219,7 @@
         SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, steNo);
         SteProtocol steProtocol = steThread.getSteProtocol();
         if (steProtocol == null) { return; }
-        if (steProtocol.getStatusType().equals(SteStatusType.IDLE)) {
+        if (steProtocol.isIdle()) {
             // 鍫嗗灈鏈虹┖闂�
             if (crnProtocol.getStatusType().equals(CrnStatusType.IDLE) || crnProtocol.getTaskNo() == 0) {
                 LocMast locMast;
@@ -860,8 +1231,8 @@
                     crnCommand.setCrnNo(crnProtocol.getCrnNo()); // 鍫嗗灈鏈虹紪鍙�
                     crnCommand.setTaskNo(wrkMast.getWrkNo().shortValue()); // 宸ヤ綔鍙�
                     crnCommand.setAckFinish((short) 0);  // 浠诲姟瀹屾垚纭浣�
-                    crnCommand.setTaskMode(CrnTaskModeType.LOC_MOVE); // 浠诲姟妯″紡:  搴撲綅绉昏浆
-                    crnCommand.setSourcePosX(steProtocol.getRow());     // 婧愬簱浣嶆帓
+                    crnCommand.setTaskMode(CrnTaskModeType.STE_MOVE); // 浠诲姟妯″紡:  搴撲綅绉昏浆
+                    crnCommand.setSourcePosX(Utils.getGroupRow(steProtocol.getRow().intValue()).shortValue());     // 婧愬簱浣嶆帓
                     crnCommand.setSourcePosY(steProtocol.getBay());     // 婧愬簱浣嶅垪
                     crnCommand.setSourcePosZ(steProtocol.getLev());     // 婧愬簱浣嶅眰
                     crnCommand.setDestinationPosX(Utils.getGroupRow(locMast.getLocNo()).shortValue());     // 鐩爣搴撲綅鎺�
@@ -870,6 +1241,8 @@
                     if (!MessageQueue.offer(SlaveType.Crn, wrkMast.getCrnNo(), new Task(2, crnCommand))) {
                         log.error("鍫嗗灈鏈哄懡浠や笅鍙戝け璐ワ紝鍫嗗灈鏈哄彿={}锛屼换鍔℃暟鎹�={}", wrkMast.getCrnNo(), JSON.toJSON(crnCommand));
                     } else {
+                        // 淇敼绌挎杞﹁繍琛屼腑鎺掑垪灞�
+                        steThread.modifyPos(Utils.getGroupRow(locMast.getLocNo()), locMast.getBay1(), locMast.getLev1());
                         // 淇敼宸ヤ綔妗g姸鎬� 3.灏忚溅寰呮惉 => 4.杩佸叆灏忚溅
                         Date now = new Date();
                         wrkMast.setWrkSts(4L);
@@ -887,8 +1260,8 @@
                     crnCommand.setCrnNo(crnProtocol.getCrnNo()); // 鍫嗗灈鏈虹紪鍙�
                     crnCommand.setTaskNo(wrkMast.getWrkNo().shortValue()); // 宸ヤ綔鍙�
                     crnCommand.setAckFinish((short) 0);  // 浠诲姟瀹屾垚纭浣�
-                    crnCommand.setTaskMode(CrnTaskModeType.LOC_MOVE); // 浠诲姟妯″紡:  搴撲綅绉昏浆
-                    crnCommand.setSourcePosX(steProtocol.getRow());     // 婧愬簱浣嶆帓
+                    crnCommand.setTaskMode(CrnTaskModeType.STE_MOVE); // 浠诲姟妯″紡:  搴撲綅绉昏浆
+                    crnCommand.setSourcePosX(Utils.getGroupRow(steProtocol.getRow().intValue()).shortValue());     // 婧愬簱浣嶆帓
                     crnCommand.setSourcePosY(steProtocol.getBay());     // 婧愬簱浣嶅垪
                     crnCommand.setSourcePosZ(steProtocol.getLev());     // 婧愬簱浣嶅眰
                     crnCommand.setDestinationPosX(Utils.getGroupRow(locMast.getLocNo()).shortValue());     // 鐩爣搴撲綅鎺�
@@ -897,6 +1270,8 @@
                     if (!MessageQueue.offer(SlaveType.Crn, wrkMast.getCrnNo(), new Task(2, crnCommand))) {
                         log.error("鍫嗗灈鏈哄懡浠や笅鍙戝け璐ワ紝鍫嗗灈鏈哄彿={}锛屼换鍔℃暟鎹�={}", wrkMast.getCrnNo(), JSON.toJSON(crnCommand));
                     } else {
+                        // 淇敼绌挎杞﹁繍琛屼腑鎺掑垪灞�
+                        steThread.modifyPos(Utils.getGroupRow(locMast.getLocNo()), locMast.getBay1(), locMast.getLev1());
                         // 淇敼宸ヤ綔妗g姸鎬� 12.灏忚溅寰呮惉 => 13.杩佸叆灏忚溅
                         Date now = new Date();
                         wrkMast.setWrkSts(13L);
@@ -921,7 +1296,7 @@
         SteProtocol steProtocol = steThread.getSteProtocol();
         if (steProtocol == null) { return; }
         // 绌挎杞︾┖闂�
-        if (steProtocol.getStatusType().equals(SteStatusType.IDLE)) {
+        if (steProtocol.isIdle()) {
             // 鍫嗗灈鏈虹┖闂�
             if (crnProtocol.getStatusType().equals(CrnStatusType.IDLE) || crnProtocol.getTaskNo() == 0) {
 
@@ -937,8 +1312,8 @@
                 crnCommand.setCrnNo(crnProtocol.getCrnNo()); // 鍫嗗灈鏈虹紪鍙�
                 crnCommand.setTaskNo(wrkMast.getWrkNo().shortValue()); // 宸ヤ綔鍙�
                 crnCommand.setAckFinish((short) 0);  // 浠诲姟瀹屾垚纭浣�
-                crnCommand.setTaskMode(CrnTaskModeType.LOC_MOVE); // 浠诲姟妯″紡:  搴撲綅绉昏浆
-                crnCommand.setSourcePosX(steProtocol.getRow());     // 婧愬簱浣嶆帓
+                crnCommand.setTaskMode(CrnTaskModeType.STE_MOVE); // 浠诲姟妯″紡:  搴撲綅绉昏浆
+                crnCommand.setSourcePosX(Utils.getGroupRow(steProtocol.getRow().intValue()).shortValue());     // 婧愬簱浣嶆帓
                 crnCommand.setSourcePosY(steProtocol.getBay());     // 婧愬簱浣嶅垪
                 crnCommand.setSourcePosZ(steProtocol.getLev());     // 婧愬簱浣嶅眰
                 crnCommand.setDestinationPosX(Utils.getGroupRow(idleLocNo).shortValue());     // 鐩爣搴撲綅鎺�
@@ -947,7 +1322,8 @@
                 if (!MessageQueue.offer(SlaveType.Crn, wrkMast.getCrnNo(), new Task(2, crnCommand))) {
                     log.error("鍫嗗灈鏈哄懡浠や笅鍙戝け璐ワ紝鍫嗗灈鏈哄彿={}锛屼换鍔℃暟鎹�={}", wrkMast.getCrnNo(), JSON.toJSON(crnCommand));
                 } else {
-
+                    // 淇敼绌挎杞﹁繍琛屼腑鎺掑垪灞�
+                    steThread.modifyPos(Utils.getGroupRow(idleLocNo), Utils.getBay(idleLocNo), Utils.getLev(idleLocNo));
                     // 淇敼宸ヤ綔妗g姸鎬� 3.灏忚溅寰呮惉 => 5.杩佸嚭灏忚溅
                     Date now = new Date();
                     wrkMast.setWrkSts(5L);
@@ -978,15 +1354,83 @@
                 // 鑾峰彇鍏ュ簱寰呯‘璁ゅ伐浣滄。
                 WrkMast wrkMast = wrkMastMapper.selectCrnWaiting(crnProtocol.getTaskNo().intValue());
                 if (wrkMast == null) {
-                    log.error("鍫嗗灈鏈哄浜庣瓑寰呯‘璁や笖浠诲姟瀹屾垚鐘舵�侊紝浣嗘湭鎵惧埌宸ヤ綔妗c�傚爢鍨涙満鍙�={}锛屽伐浣滃彿={}", crn.getId(), crnProtocol.getTaskNo());
-                    continue;
+
+                    // 鍏呯數浠诲姟
+                    WrkCharge wrkCharge = wrkChargeService.selectById(crnProtocol.getTaskNo());
+                    if (wrkCharge == null) {
+                        log.error("鍫嗗灈鏈哄浜庣瓑寰呯‘璁や笖浠诲姟瀹屾垚鐘舵�侊紝浣嗘湭鎵惧埌宸ヤ綔妗c�傚爢鍨涙満鍙�={}锛屽伐浣滃彿={}", crn.getId(), crnProtocol.getTaskNo());
+                        continue;
+                    } else {
+                        // 灏忚溅鎼嚦鎸囧畾搴撲綅瀹屾垚
+                        if (wrkCharge.getWrkSts() == 23) {
+                            // 23.鍚婅溅鎼繍 ===>> 24.灏忚溅鍒拌揪
+                            wrkCharge.setWrkSts(24L);
+                            if (!wrkChargeService.updateById(wrkCharge)) {
+                                log.error("淇敼鍏呯數浠诲姟鐘舵�� 23.鍚婅溅鎼繍 ===>> 24.灏忚溅鍒拌揪 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkCharge.getWrkNo());
+                            } else {
+                                // 鍫嗗灈鏈哄浣�
+                                crnThread.setResetFlag(true);
+                                // 绌挎杞﹂噸鏂板畾浣嶆帓鍒楀眰
+                                SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, wrkCharge.getSteNo());
+                                if (!steThread.confirmPos()) {
+                                    log.error("{}鍙风┛姊溅閲嶆柊瀹氫綅澶辫触锛佷綔涓氬厖鐢典换鍔″彿锛歿}", wrkCharge.getSteNo(), wrkCharge.getWrkNo());
+                                }
+                            }
+                        }
+                    }
+
                 }
-                // 鍏ュ簱 ==>> 璐х墿鎼叆搴�
-                if (wrkMast.getWrkSts() == 7){
-                    // 鍒ゆ柇鏄惁闇�瑕佸皬杞﹀叆搴�
-                    if (locMastService.isOutMost(wrkMast.getLocNo())) {
-                        // ==> 9.鍏ュ簱瀹屾垚
-                        wrkMast.setWrkSts(9L);
+                if (wrkMast == null) { continue; }
+                if (wrkMast.getIoType() != 11) {
+                    // 鍏ュ簱 ==>> 璐х墿鎼叆搴�
+                    if (wrkMast.getWrkSts() == 7){
+                        // 鍒ゆ柇鏄惁闇�瑕佸皬杞﹀叆搴�
+                        if (locMastService.isOutMost(wrkMast.getLocNo())) {
+                            // ==> 9.鍏ュ簱瀹屾垚
+                            wrkMast.setWrkSts(9L);
+                            Date now = new Date();
+                            wrkMast.setCrnEndTime(now);
+                            wrkMast.setModiTime(now);
+                            // 淇敼鎴愬姛鍚庡浣嶅爢鍨涙満
+                            if (wrkMastMapper.updateById(wrkMast) > 0) {
+                                // 鍫嗗灈鏈哄浣�
+                                crnThread.setResetFlag(true);
+                            } else {
+                                log.error("淇敼宸ヤ綔妗g姸鎬� 7.鍚婅溅鍏ュ簱涓� => 9.鍏ュ簱瀹屾垚 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
+                            }
+                        } else {
+                            // 缁欑┛姊溅涓嬪彂鍛戒护
+                            Integer steNo = wrkMast.getSteNo();
+                            SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, steNo);
+                            SteProtocol steProtocol = steThread.getSteProtocol();
+                            if (steProtocol == null) { continue; }
+                            if (steProtocol.isIdle()) {
+                                // 鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
+                                SteCommand steCommand = new SteCommand();
+                                steCommand.setSteNo(steNo); // 绌挎杞︾紪鍙�
+                                steCommand.setTaskNo(wrkMast.getWrkNo()); // 宸ヤ綔鍙�
+                                steCommand.setTaskMode(SteTaskModeType.findInByLoc(wrkMast.getLocNo())); // 浠诲姟妯″紡: 鎼叆搴�
+                                if (!MessageQueue.offer(SlaveType.Ste, steNo, new Task(2, steCommand))) {
+                                    log.error("绌挎杞﹀懡浠や笅鍙戝け璐ワ紝绌挎杞﹀彿={}锛屼换鍔℃暟鎹�={}", steNo, JSON.toJSON(steCommand));
+                                } else {
+                                    // 淇敼宸ヤ綔妗g姸鎬� 7.鍚婅溅鍏ュ簱涓� => 8.灏忚溅鎼叆搴�
+                                    wrkMast.setWrkSts(8L);
+                                    Date now = new Date();
+                                    wrkMast.setCrnEndTime(now);
+                                    wrkMast.setModiTime(now);
+                                    if (wrkMastMapper.updateById(wrkMast) > 0) {
+                                        // 鍫嗗灈鏈哄浣�
+                                        crnThread.setResetFlag(true);
+                                    } else {
+                                        log.error("淇敼宸ヤ綔妗g姸鎬� 7.鍚婅溅鍏ュ簱涓� => 8.灏忚溅鎼叆搴� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
+                                    }
+                                }
+                            }
+                        }
+                        // 鍏ュ簱 ===>> 杩佸叆灏忚溅 瀹屾垚
+                    } else if (wrkMast.getWrkSts() == 4) {
+                        // 4.杩佸叆灏忚溅 ==> 6.灏忚溅寰呭叆
+                        wrkMast.setWrkSts(6L);
                         Date now = new Date();
                         wrkMast.setCrnEndTime(now);
                         wrkMast.setModiTime(now);
@@ -994,81 +1438,170 @@
                         if (wrkMastMapper.updateById(wrkMast) > 0) {
                             // 鍫嗗灈鏈哄浣�
                             crnThread.setResetFlag(true);
+                            // 绌挎杞﹂噸鏂板畾浣嶆帓鍒楀眰
+                            SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, wrkMast.getSteNo());
+                            if (!steThread.confirmPos()) {
+                                log.error("{}鍙风┛姊溅閲嶆柊瀹氫綅澶辫触锛佷綔涓氬伐浣滄。浠诲姟鍙凤細{}", wrkMast.getSteNo(), wrkMast.getWrkNo());
+                            }
+                            // 绌挎杞﹀幓寰呮満浣�
+                            BasSte basSte = basSteService.selectById(wrkMast.getSteNo());
+                            SteCommand steCommand = new SteCommand();
+                            steCommand.setSteNo(wrkMast.getSteNo()); // 绌挎杞︾紪鍙�
+                            steCommand.setTaskNo(9999); // 宸ヤ綔鍙�
+                            steCommand.setTaskMode(SteTaskModeType.findWaiting(basSte.getRow())); // 浠诲姟妯″紡:  鍘昏繎鐐� 绛夊緟鍫嗗灈鏈哄弶鍙�
+//                        steCommand.setRow(Utils.getGroupRow(steProtocol.getRow().intValue()).shortValue());
+//                        steCommand.setBay(steProtocol.getBay());
+//                        steCommand.setLev(steProtocol.getLev());
+                            if (!MessageQueue.offer(SlaveType.Ste, wrkMast.getSteNo(), new Task(2, steCommand))) {
+                                log.error("绌挎杞﹀緟鏈轰綅鍛戒护涓嬪彂澶辫触锛岀┛姊溅鍙�={}锛屼换鍔℃暟鎹�={}", wrkMast.getSteNo(), JSON.toJSON(steCommand));
+                            }
                         } else {
-                            log.error("淇敼宸ヤ綔妗g姸鎬� 7.鍚婅溅鍏ュ簱涓� => 9.鍏ュ簱瀹屾垚 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
+                            log.error("淇敼宸ヤ綔妗g姸鎬� 4.杩佸叆灏忚溅 => 6.灏忚溅寰呭叆 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
                         }
-                    } else {
+                        // 鍏ュ簱 ===>> 杩佸嚭灏忚溅 瀹屾垚
+                    } else if (wrkMast.getWrkSts() == 5) {
+                        // 5.杩佸嚭灏忚溅 ==> 6.灏忚溅寰呭叆
+                        wrkMast.setWrkSts(6L);
+                        Date now = new Date();
+                        wrkMast.setCrnEndTime(now);
+                        wrkMast.setModiTime(now);
+                        // 淇敼鎴愬姛鍚庡浣嶅爢鍨涙満
+                        if (wrkMastMapper.updateById(wrkMast) > 0) {
+                            // 鍫嗗灈鏈哄浣�
+                            crnThread.setResetFlag(true);
+                            // 绌挎杞﹂噸鏂板畾浣嶆帓鍒楀眰
+                            SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, wrkMast.getSteNo());
+                            if (!steThread.confirmPos()) {
+                                log.error("{}鍙风┛姊溅閲嶆柊瀹氫綅澶辫触锛佷綔涓氬伐浣滄。浠诲姟鍙凤細{}", wrkMast.getSteNo(), wrkMast.getWrkNo());
+                            }
+                            // 绌挎杞﹀幓寰呮満浣�
+                            BasSte basSte = basSteService.selectById(wrkMast.getSteNo());
+                            SteCommand steCommand = new SteCommand();
+                            steCommand.setSteNo(wrkMast.getSteNo()); // 绌挎杞︾紪鍙�
+                            steCommand.setTaskNo(9999); // 宸ヤ綔鍙�
+                            steCommand.setTaskMode(SteTaskModeType.findWaiting(basSte.getRow())); // 浠诲姟妯″紡:  鍘昏繎鐐� 绛夊緟鍫嗗灈鏈哄弶鍙�
+//                        steCommand.setRow(Utils.getGroupRow(steProtocol.getRow().intValue()).shortValue());
+//                        steCommand.setBay(steProtocol.getBay());
+//                        steCommand.setLev(steProtocol.getLev());
+                            if (!MessageQueue.offer(SlaveType.Ste, wrkMast.getSteNo(), new Task(2, steCommand))) {
+                                log.error("绌挎杞﹀緟鏈轰綅鍛戒护涓嬪彂澶辫触锛岀┛姊溅鍙�={}锛屼换鍔℃暟鎹�={}", wrkMast.getSteNo(), JSON.toJSON(steCommand));
+                            }
+                        } else {
+                            log.error("淇敼宸ヤ綔妗g姸鎬� 5.杩佸嚭灏忚溅 => 6.灏忚溅寰呭叆 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
+                        }
+                        // 鍑哄簱 ===>> 杩佸叆灏忚溅 瀹屾垚
+                    } else if (wrkMast.getWrkSts() == 13) {
                         // 缁欑┛姊溅涓嬪彂鍛戒护
                         Integer steNo = wrkMast.getSteNo();
                         SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, steNo);
                         SteProtocol steProtocol = steThread.getSteProtocol();
                         if (steProtocol == null) { continue; }
-                        if (steProtocol.getStatusType().equals(SteStatusType.IDLE)) {
-                            // 鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
-                            SteCommand steCommand = new SteCommand();
-                            steCommand.setSteNo(steNo); // 绌挎杞︾紪鍙�
-                            steCommand.setTaskNo(wrkMast.getWrkNo()); // 宸ヤ綔鍙�
-                            steCommand.setTaskMode(SteTaskModeType.TO_B); // 浠诲姟妯″紡:  鍘昏繎鐐� 绛夊緟鍫嗗灈鏈哄弶鍙�
-                            // todo:luxiaotao
-                            if (!MessageQueue.offer(SlaveType.Ste, steNo, new Task(2, steCommand))) {
-                                log.error("绌挎杞﹀懡浠や笅鍙戝け璐ワ紝绌挎杞﹀彿={}锛屼换鍔℃暟鎹�={}", steNo, JSON.toJSON(steCommand));
-                            } else {
-                                // 淇敼宸ヤ綔妗g姸鎬� 7.鍚婅溅鍏ュ簱涓� => 8.灏忚溅鎼叆搴�
-                                wrkMast.setWrkSts(8L);
-                                Date now = new Date();
-                                wrkMast.setCrnEndTime(now);
-                                wrkMast.setModiTime(now);
-                                if (wrkMastMapper.updateById(wrkMast) > 0) {
-                                    // 鍫嗗灈鏈哄浣�
-                                    crnThread.setResetFlag(true);
-                                } else {
-                                    log.error("淇敼宸ヤ綔妗g姸鎬� 7.鍚婅溅鍏ュ簱涓� => 8.灏忚溅鎼叆搴� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
-                                }
-                            }
+                        // 绌挎杞﹂噸鏂板畾浣嶆帓鍒楀眰
+                        if (!steThread.confirmPos()) {
+                            log.error("{}鍙风┛姊溅閲嶆柊瀹氫綅澶辫触锛佷綔涓氬伐浣滄。浠诲姟鍙凤細{}", wrkMast.getSteNo(), wrkMast.getWrkNo());
                         }
-                    }
-                // 鍏ュ簱 ===>> 杩佸叆灏忚溅 瀹屾垚
-                } else if (wrkMast.getWrkSts() == 4) {
-                    // 4.杩佸叆灏忚溅 ==> 6.灏忚溅寰呭叆
-                    wrkMast.setWrkSts(6L);
-                    Date now = new Date();
-                    wrkMast.setCrnEndTime(now);
-                    wrkMast.setModiTime(now);
-                    // 淇敼鎴愬姛鍚庡浣嶅爢鍨涙満
-                    if (wrkMastMapper.updateById(wrkMast) > 0) {
-                        // 鍫嗗灈鏈哄浣�
-                        crnThread.setResetFlag(true);
-                    } else {
-                        log.error("淇敼宸ヤ綔妗g姸鎬� 4.杩佸叆灏忚溅 => 6.灏忚溅寰呭叆 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
-                    }
-                // 鍏ュ簱 ===>> 杩佸嚭灏忚溅 瀹屾垚
-                } else if (wrkMast.getWrkSts() == 5) {
-                    // 5.杩佸嚭灏忚溅 ==> 6.灏忚溅寰呭叆
-                    wrkMast.setWrkSts(6L);
-                    Date now = new Date();
-                    wrkMast.setCrnEndTime(now);
-                    wrkMast.setModiTime(now);
-                    // 淇敼鎴愬姛鍚庡浣嶅爢鍨涙満
-                    if (wrkMastMapper.updateById(wrkMast) > 0) {
-                        // 鍫嗗灈鏈哄浣�
-                        crnThread.setResetFlag(true);
-                    } else {
-                        log.error("淇敼宸ヤ綔妗g姸鎬� 5.杩佸嚭灏忚溅 => 6.灏忚溅寰呭叆 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
-                    }
-                // 鍑哄簱 ===>> 杩佸叆灏忚溅 瀹屾垚
-                } else if (wrkMast.getWrkSts() == 13) {
-                    // 缁欑┛姊溅涓嬪彂鍛戒护
-                    Integer steNo = wrkMast.getSteNo();
-                    SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, steNo);
-                    SteProtocol steProtocol = steThread.getSteProtocol();
-                    if (steProtocol == null) { continue; }
-                    if (steProtocol.getStatusType().equals(SteStatusType.IDLE)) {
                         // 鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
                         SteCommand steCommand = new SteCommand();
                         steCommand.setSteNo(steNo); // 绌挎杞︾紪鍙�
                         steCommand.setTaskNo(wrkMast.getWrkNo()); // 宸ヤ綔鍙�
-                        steCommand.setTaskMode(SteTaskModeType.TO_B); // 浠诲姟妯″紡:  鍘昏繎鐐� 绛夊緟鍫嗗灈鏈哄弶鍙�
-                        // todo:luxiaotao
+                        steCommand.setTaskMode(SteTaskModeType.findOutByLoc(wrkMast.getSourceLocNo())); // 浠诲姟妯″紡:  鎼嚭搴�
+                        if (!MessageQueue.offer(SlaveType.Ste, steNo, new Task(2, steCommand))) {
+                            log.error("绌挎杞﹀懡浠や笅鍙戝け璐ワ紝绌挎杞﹀彿={}锛屼换鍔℃暟鎹�={}", steNo, JSON.toJSON(steCommand));
+                        } else {
+                            // 13.杩佸叆灏忚溅 ==> 14.灏忚溅鎼嚭搴�
+                            wrkMast.setWrkSts(14L);
+                            Date now = new Date();
+                            wrkMast.setCrnEndTime(now);
+                            wrkMast.setModiTime(now);
+                            // 淇敼鎴愬姛鍚庡浣嶅爢鍨涙満
+                            if (wrkMastMapper.updateById(wrkMast) > 0) {
+                                // 鍫嗗灈鏈哄浣�
+                                crnThread.setResetFlag(true);
+                            } else {
+                                log.error("淇敼宸ヤ綔妗g姸鎬� 13.杩佸叆灏忚溅 ==> 14.灏忚溅鎼嚭搴� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
+                            }
+                        }
+                        // 绉诲簱 ===>> 鍫嗗灈鏈烘惉鑷崇洰鏍囧簱浣嶇粍 瀹屾垚
+                    }
+                // 搴撲綅绉昏浆
+                } else {
+                    if (wrkMast.getWrkSts() == 16) {
+                        Date now = new Date();
+                        if (locMastService.isOutMost(wrkMast.getLocNo())) {
+                            // 16.鍚婅溅鍑哄簱涓� ==> 9.鍏ュ簱瀹屾垚
+                            wrkMast.setWrkSts(9L);
+                            wrkMast.setCrnEndTime(now);
+                        } else {
+                            // 16.鍚婅溅鍑哄簱涓� ==> 9.鍏ュ簱瀹屾垚
+                            wrkMast.setWrkSts(9L);
+                        }
+                        wrkMast.setModiTime(now);
+                        // 淇敼鎴愬姛鍚庡浣嶅爢鍨涙満
+                        if (wrkMastMapper.updateById(wrkMast) > 0) {
+                            // 鍫嗗灈鏈哄浣�
+                            crnThread.setResetFlag(true);
+                        } else {
+                            log.error("淇敼宸ヤ綔妗g姸鎬� 16.鍚婅溅鍑哄簱涓� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
+                        }
+                    } else if (wrkMast.getWrkSts() == 7){
+                        // 鍒ゆ柇鏄惁闇�瑕佸皬杞﹀叆搴�
+                        if (locMastService.isOutMost(wrkMast.getLocNo())) {
+                            // ==> 9.鍏ュ簱瀹屾垚
+                            wrkMast.setWrkSts(9L);
+                            Date now = new Date();
+                            wrkMast.setCrnEndTime(now);
+                            wrkMast.setModiTime(now);
+                            // 淇敼鎴愬姛鍚庡浣嶅爢鍨涙満
+                            if (wrkMastMapper.updateById(wrkMast) > 0) {
+                                // 鍫嗗灈鏈哄浣�
+                                crnThread.setResetFlag(true);
+                            } else {
+                                log.error("淇敼宸ヤ綔妗g姸鎬� 7.鍚婅溅鍏ュ簱涓� => 9.鍏ュ簱瀹屾垚 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
+                            }
+                        } else {
+                            // 缁欑┛姊溅涓嬪彂鍛戒护
+                            Integer steNo = wrkMast.getSteNo();
+                            SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, steNo);
+                            SteProtocol steProtocol = steThread.getSteProtocol();
+                            if (steProtocol == null) { continue; }
+                            if (steProtocol.isIdle()) {
+                                // 鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
+                                SteCommand steCommand = new SteCommand();
+                                steCommand.setSteNo(steNo); // 绌挎杞︾紪鍙�
+                                steCommand.setTaskNo(wrkMast.getWrkNo()); // 宸ヤ綔鍙�
+                                steCommand.setTaskMode(SteTaskModeType.findInByLoc(wrkMast.getLocNo())); // 浠诲姟妯″紡: 鎼叆搴�
+                                if (!MessageQueue.offer(SlaveType.Ste, steNo, new Task(2, steCommand))) {
+                                    log.error("绌挎杞﹀懡浠や笅鍙戝け璐ワ紝绌挎杞﹀彿={}锛屼换鍔℃暟鎹�={}", steNo, JSON.toJSON(steCommand));
+                                } else {
+                                    // 淇敼宸ヤ綔妗g姸鎬� 7.鍚婅溅鍏ュ簱涓� => 8.灏忚溅鎼叆搴�
+                                    wrkMast.setWrkSts(8L);
+                                    Date now = new Date();
+                                    wrkMast.setCrnEndTime(now);
+                                    wrkMast.setModiTime(now);
+                                    if (wrkMastMapper.updateById(wrkMast) > 0) {
+                                        // 鍫嗗灈鏈哄浣�
+                                        crnThread.setResetFlag(true);
+                                    } else {
+                                        log.error("淇敼宸ヤ綔妗g姸鎬� 7.鍚婅溅鍏ュ簱涓� => 8.灏忚溅鎼叆搴� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
+                                    }
+                                }
+                            }
+                        }
+                    } else if (wrkMast.getWrkSts() == 13) {
+                        // 缁欑┛姊溅涓嬪彂鍛戒护
+                        Integer steNo = wrkMast.getSteNo();
+                        SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, steNo);
+                        SteProtocol steProtocol = steThread.getSteProtocol();
+                        if (steProtocol == null) { continue; }
+                        // 绌挎杞﹂噸鏂板畾浣嶆帓鍒楀眰
+                        if (!steThread.confirmPos()) {
+                            log.error("{}鍙风┛姊溅閲嶆柊瀹氫綅澶辫触锛佷綔涓氬伐浣滄。浠诲姟鍙凤細{}", wrkMast.getSteNo(), wrkMast.getWrkNo());
+                        }
+                        // 鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
+                        SteCommand steCommand = new SteCommand();
+                        steCommand.setSteNo(steNo); // 绌挎杞︾紪鍙�
+                        steCommand.setTaskNo(wrkMast.getWrkNo()); // 宸ヤ綔鍙�
+                        steCommand.setTaskMode(SteTaskModeType.findOutByLoc(wrkMast.getSourceLocNo())); // 浠诲姟妯″紡:  鎼嚭搴�
                         if (!MessageQueue.offer(SlaveType.Ste, steNo, new Task(2, steCommand))) {
                             log.error("绌挎杞﹀懡浠や笅鍙戝け璐ワ紝绌挎杞﹀彿={}锛屼换鍔℃暟鎹�={}", steNo, JSON.toJSON(steCommand));
                         } else {
@@ -1094,62 +1627,109 @@
     /**
      * 鎵ц瀵瑰伐浣滄。鐨勫畬鎴愭搷浣�
      */
-    public void carGenerateStore() {
+    public synchronized void carGenerateStore() {
         Date now = new Date();
         for (SteSlave ste : slaveProperties.getSte()) {
             // 鑾峰彇绌挎杞︿俊鎭�
             SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, ste.getId());
             SteProtocol steProtocol = steThread.getSteProtocol();
             if (steProtocol == null) { continue; }
-            if (steProtocol.getStatusType().equals(SteStatusType.WAITING) && steProtocol.getTaskNo() != 0) {
-                // 鏌ヨ鏄惁鏈夊緟鍏ュ簱鐨勪换鍔�
-                WrkMast wrkMast = wrkMastMapper.selectCarWaiting(steProtocol.getTaskNo());
-                if (wrkMast == null) { continue; }
+            if (steProtocol.getWaiting() && steProtocol.getTaskNo() != 0) {
+                if (steProtocol.getTaskNo() == 9999) {
+                    steThread.setResetFlag(true);
+                } else {
+                    // 鏌ヨ鏄惁鏈夊緟鍏ュ簱鐨勪换鍔�
+                    WrkMast wrkMast = wrkMastMapper.selectCarWaiting(steProtocol.getTaskNo().intValue());
+                    if (wrkMast == null) {
+                        // 鍏呯數浠诲姟
+                        WrkCharge wrkCharge = wrkChargeService.selectById(steProtocol.getTaskNo());
+                        if (wrkCharge == null) {
+                            continue;
+                        } else {
+                            if (wrkCharge.getWrkSts() == 21) {
+                                // 21.鍑嗗鍏呯數 ===>> 22.灏忚溅寰呮惉
+                                wrkCharge.setWrkSts(22L);
+                                if (!wrkChargeService.updateById(wrkCharge)) {
+                                    log.error("淇敼鍏呯數浠诲姟鐘舵�� 21.鍑嗗鍏呯數 ===>> 22.灏忚溅寰呮惉 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkCharge.getWrkNo());
+                                } else {
+                                    steThread.setResetFlag(true);
+                                }
+                            } else if (wrkCharge.getWrkSts() == 25) {
+                                // 25.灏忚溅鍘诲厖鐢� ===>> 26.绛夊緟鍏呯數
+                                wrkCharge.setWrkSts(26L);
+                                if (!wrkChargeService.updateById(wrkCharge)) {
+                                    log.error("淇敼鍏呯數浠诲姟鐘舵�� 25.灏忚溅鍘诲厖鐢� ===>> 26.绛夊緟鍏呯數 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkCharge.getWrkNo());
+                                } else {
+                                    steThread.setResetFlag(true);
+                                }
+                            }
+                        }
+                    }
 
-                switch (wrkMast.getWrkSts().intValue()) {
-                    case 2:
-                        // 淇敼宸ヤ綔妗g姸鎬� 2.璁惧涓婅蛋 => 3.灏忚溅寰呮惉
-                        wrkMast.setWrkSts(3L);
-                        wrkMast.setModiTime(now);
-                        if (wrkMastMapper.updateById(wrkMast) == 0) {
-                            log.error("淇敼宸ヤ綔妗g姸鎬� 2.璁惧涓婅蛋 => 3.灏忚溅寰呮惉 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
-                        } else {
-                            steThread.setResetFlag(true);
-                        }
-                        break;
-                    case 8:
-                        // 淇敼宸ヤ綔妗g姸鎬� 8.灏忚溅鎼叆搴� => 9.鍏ュ簱瀹屾垚
-                        wrkMast.setWrkSts(9L);
-                        wrkMast.setModiTime(now);
-                        if (wrkMastMapper.updateById(wrkMast) == 0) {
-                            log.error("淇敼宸ヤ綔妗g姸鎬� 8.灏忚溅鎼叆搴� => 9.鍏ュ簱瀹屾垚 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
-                        } else {
-                            steThread.setResetFlag(true);
-                        }
-                        break;
-                    case 11:
-                        // 淇敼宸ヤ綔妗g姸鎬� 11.鐢熸垚鍑哄簱ID => 12.灏忚溅寰呮惉
-                        wrkMast.setWrkSts(12L);
-                        wrkMast.setModiTime(now);
-                        if (wrkMastMapper.updateById(wrkMast) == 0) {
-                            log.error("淇敼宸ヤ綔妗g姸鎬� 11.鐢熸垚鍑哄簱ID => 12.灏忚溅寰呮惉 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
-                        } else {
-                            steThread.setResetFlag(true);
-                        }
-                        break;
-                    case 14:
-                        // 淇敼宸ヤ綔妗g姸鎬� 14.灏忚溅鎼嚭搴� => 15.绛夊緟鍚婅溅
-                        wrkMast.setWrkSts(15L);
-                        wrkMast.setModiTime(now);
-                        if (wrkMastMapper.updateById(wrkMast) == 0) {
-                            log.error("淇敼宸ヤ綔妗g姸鎬� 14.灏忚溅鎼嚭搴� => 15.绛夊緟鍚婅溅 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
-                        } else {
-                            steThread.setResetFlag(true);
-                        }
-                        break;
+                    if (wrkMast == null) { continue; }
+                    switch (wrkMast.getWrkSts().intValue()) {
+                        case 2:
+                            // 淇敼宸ヤ綔妗g姸鎬� 2.璁惧涓婅蛋 => 3.灏忚溅寰呮惉
+                            wrkMast.setWrkSts(3L);
+                            wrkMast.setModiTime(now);
+                            if (wrkMastMapper.updateById(wrkMast) == 0) {
+                                log.error("淇敼宸ヤ綔妗g姸鎬� 2.璁惧涓婅蛋 => 3.灏忚溅寰呮惉 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
+                            } else {
+                                steThread.setResetFlag(true);
+                            }
+                            break;
+                        case 8:
+                            // 淇敼宸ヤ綔妗g姸鎬� 8.灏忚溅鎼叆搴� => 9.鍏ュ簱瀹屾垚
+                            wrkMast.setWrkSts(9L);
+                            wrkMast.setModiTime(now);
+                            if (wrkMastMapper.updateById(wrkMast) == 0) {
+                                log.error("淇敼宸ヤ綔妗g姸鎬� 8.灏忚溅鎼叆搴� => 9.鍏ュ簱瀹屾垚 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
+                            } else {
+                                steThread.setResetFlag(true);
+                            }
+                            break;
+                        case 11:
+                            if (wrkMast.getIoType() != 11) {
+                                // 淇敼宸ヤ綔妗g姸鎬� 11.鐢熸垚鍑哄簱ID => 12.灏忚溅寰呮惉
+                                wrkMast.setWrkSts(12L);
+                            } else {
+                                if (Cools.isEmpty(wrkMast.getMk())) {
+                                    log.error("绉诲簱宸ヤ綔妗f病鏈夋祦绋嬫爣璁帮紒锛侊紝宸ヤ綔鍙�={}", wrkMast.getWrkNo());
+                                } else {
+                                    if (wrkMast.getMk().equals("I")) {
+                                        String locNo = wrkMast.getLocNo();
+                                        if (Utils.getGroupRow(locNo).equals(Utils.getGroupRow(steProtocol.getRow().intValue())) && steProtocol.getBay() == Utils.getBay(locNo) && steProtocol.getLev() == Utils.getLev(locNo)) {
+                                            // 淇敼宸ヤ綔妗g姸鎬� 11.鐢熸垚鍑哄簱ID => 6.灏忚溅寰呭叆
+                                            wrkMast.setWrkSts(6L);
+                                        } else {
+                                            // 淇敼宸ヤ綔妗g姸鎬� 11.鐢熸垚鍑哄簱ID => 3.灏忚溅寰呮惉
+                                            wrkMast.setWrkSts(3L);
+                                        }
+                                    } else if (wrkMast.getMk().equals("O")) {
+                                        // 淇敼宸ヤ綔妗g姸鎬� 11.鐢熸垚鍑哄簱ID => 12.灏忚溅寰呮惉
+                                        wrkMast.setWrkSts(12L);
+                                    }
+                                }
+                            }
+                            wrkMast.setModiTime(now);
+                            if (wrkMastMapper.updateById(wrkMast) == 0) {
+                                log.error("淇敼宸ヤ綔妗g姸鎬� 11.鐢熸垚鍑哄簱ID => 12.灏忚溅寰呮惉 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
+                            } else {
+                                steThread.setResetFlag(true);
+                            }
+                            break;
+                        case 14:
+                            // 淇敼宸ヤ綔妗g姸鎬� 14.灏忚溅鎼嚭搴� => 15.绛夊緟鍚婅溅
+                            wrkMast.setWrkSts(15L);
+                            wrkMast.setModiTime(now);
+                            if (wrkMastMapper.updateById(wrkMast) == 0) {
+                                log.error("淇敼宸ヤ綔妗g姸鎬� 14.灏忚溅鎼嚭搴� => 15.绛夊緟鍚婅溅 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
+                            } else {
+                                steThread.setResetFlag(true);
+                            }
+                            break;
+                    }
                 }
-
-
             }
         }
     }
@@ -1294,7 +1874,7 @@
                 }
                 // 绔欑偣鏉′欢鍒ゆ柇
                 if (staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.isInEnable()
-                        && staProtocol.isEmptyMk() && (staProtocol.getWorkNo() == 0 || staProtocol.getWorkNo() == 9999 || staProtocol.getWorkNo() == 9990 || staProtocol.getWorkNo() == 9997) && staProtocol.isPakMk()) {
+                        && staProtocol.isEmptyMk() && (staProtocol.getWorkNo() == 0 ||  (staProtocol.getWorkNo() >= 9990 && staProtocol.getWorkNo() <= 9999) || staProtocol.getWorkNo() == 9997) && staProtocol.isPakMk()) {
 
                     try {
                         LocTypeDto locTypeDto = new LocTypeDto(staProtocol);
@@ -1363,6 +1943,7 @@
                 // 缁勮鍛戒护
                 LedCommand ledCommand = new LedCommand();
                 ledCommand.setWorkNo(wrkMast.getWrkNo());
+                ledCommand.setIoType(wrkMast.getIoType());
                 // 鍑哄簱妯″紡
                 switch (wrkMast.getIoType()) {
                     case 101:
@@ -1389,7 +1970,14 @@
                 ledCommand.setStaNo(wrkMast.getStaNo());
                 if (wrkMast.getIoType() != 110) {
                     List<WrkDetl> wrkDetls = wrkDetlService.findByWorkNo(wrkMast.getWrkNo());
-                    wrkDetls.forEach(wrkDetl -> ledCommand.getMatDtos().add(new MatDto(wrkDetl.getMatNo(), wrkDetl.getMatName(), wrkDetl.getQty())));
+                    wrkDetls.forEach(wrkDetl -> {
+                        if (wrkMast.getIoType() == 101) {
+                            ledCommand.getMatDtos().add(new MatDto(wrkDetl.getMatnr(), wrkDetl.getMaktx(), wrkDetl.getBatch(), wrkDetl.getAnfme()));
+                        }
+                        if (wrkMast.getIoType() == 103 && (null == wrkDetl.getInspect() || 0 == wrkDetl.getInspect())) {
+                            ledCommand.getMatDtos().add(new MatDto(wrkDetl.getMatnr(), wrkDetl.getMaktx(), wrkDetl.getBatch(), wrkDetl.getAnfme()));
+                        }
+                    });
                 }
                 commands.add(ledCommand);
             }
@@ -1405,8 +1993,6 @@
                 if (!MessageQueue.offer(SlaveType.Led, led.getId(), new Task(1, commands))) {
                     log.error("{}鍙稬ED鍛戒护涓嬪彂澶辫触锛侊紒锛乕ip锛歿}] [port锛歿}]", led.getId(), led.getIp(), led.getPort());
                     continue;
-                } else {
-                    ledThread.setLedMk(false);
                 }
             }
 
@@ -1444,9 +2030,7 @@
             for (Integer staNo : led.getStaArr()) {
                 // 鑾峰彇鍙夎溅绔欑偣
                 StaProtocol staProtocol = devpThread.getStation().get(staNo);
-                if (staProtocol == null) {
-                    continue;
-                }
+                if (staProtocol == null) { continue; }
                 if (staProtocol.getWorkNo() != 0) {
                     reset = false;
                     break;
@@ -1455,19 +2039,150 @@
             // 鑾峰彇led绾跨▼
             LedThread ledThread = (LedThread) SlaveConnection.get(SlaveType.Led, led.getDevpPlcId());
             // led鏄剧ず榛樿鍐呭
-            if (reset && !ledThread.isLedMk()) {
-                ledThread.setLedMk(true);
+            if (reset) {
                 if (!MessageQueue.offer(SlaveType.Led, led.getId(), new Task(2, new ArrayList<>()))) {
                     log.error("{}鍙稬ED鍛戒护涓嬪彂澶辫触锛侊紒锛乕ip锛歿}] [port锛歿}]", led.getId(), led.getIp(), led.getPort());
-                } else {
-
                 }
             }
         }
     }
 
+    /**
+     * 灏忚溅鐢甸噺妫�娴� ===>> 鍙戣捣鍏呯數
+     */
+    public void loopSteCharge() {
+        for (SteSlave ste : slaveProperties.getSte()) {
+            SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, ste.getId());
+            SteProtocol steProtocol = steThread.getSteProtocol();
+            BasSte basSte = basSteService.selectById(ste.getId());
+            if (Cools.isEmpty(steProtocol, basSte)) { continue; }
+            try {
+                // 鍦ㄧ嚎 绌洪棽   鏃犱綔涓氭爣璁�   涓嶅湪鍏呯數
+                if (steProtocol.getMode() == 0
+                        || !steProtocol.statusType.equals(SteStatusType.IDLE)
+                        || basSte.getPakMk().equals("Y")
+//                        || steProtocol.getChargeStatus() == 1
+                ) {
+                    continue;
+                }
+                if (!steProtocol.isEnable()) {
+                    continue;
+                }
+                if (steProtocol.getCharge() > Float.parseFloat(basSte.getChargeLine())) {
+                    continue;
+                }
+                WrkCharge wrkCharge = wrkChargeService.selectWorking(steProtocol.getSteNo().intValue());
 
+                if (wrkCharge == null) {
+                    String idleLoc = basSte.getIdleLoc();
+                    wrkCharge = new WrkCharge();
+                    wrkCharge.setSteNo(ste.getId());
+                    wrkCharge.setWrkNo(commonService.getChargeWorkNo(4));
+                    wrkCharge.setWrkSts(21L);   // 21.鍑嗗鍏呯數
+                    wrkCharge.setCrnNo(basSte.getCrnNo());
+                    wrkCharge.setIoPri((double) 10);
+                    wrkCharge.setLocNo(idleLoc);
+                    if (!wrkChargeService.insert(wrkCharge)) {
+                        log.error("淇濆瓨{}鍙风┛姊溅鍏呯數浠诲姟澶辫触!!!", ste.getId());
+                        continue;
+                    }
 
+                    // 澶勪簬鍏呯數搴撲綅缁�
+                    if (Utils.getGroupRow(idleLoc).equals(Utils.getGroupRow(steProtocol.getRow().intValue())) && steProtocol.getBay() == Utils.getBay(idleLoc) && steProtocol.getLev() == Utils.getLev(idleLoc)) {
+                        // 淇敼宸ヤ綔妗g姸鎬� 21.鍑嗗鍏呯數 => 24.灏忚溅鍒拌揪
+                        wrkCharge.setWrkSts(24L);
+                        wrkCharge.setModiTime(new Date());
+                        if (!wrkChargeService.updateById(wrkCharge)) {
+                            log.error("淇敼鍏呯數浠诲姟鐘舵�� 21.鍑嗗鍏呯數 => 24.灏忚溅鍒拌揪 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkCharge.getWrkNo());
+                        }
+                    } else {
+                        this.letCarBeWaiting(wrkCharge, ste.getId());
+                    }
 
+                } else {
+                    // filter
+                    if (wrkCharge.getWrkSts() < 26 && steProtocol.getChargeStatus() == 1) {
+                        continue;
+                    }
+
+                    // 22.灏忚溅寰呮惉
+                    if (wrkCharge.getWrkSts() == 22) {
+                        // 鎼皬杞﹁嚦鍏呯數搴撲綅
+                        LocMast locMast = locMastService.selectById(basSte.getIdleLoc());
+
+                        // 鍫嗗灈鏈哄懡浠や笅鍙戝尯 --------------------------------------------------------------------------
+                        CrnCommand crnCommand = new CrnCommand();
+                        crnCommand.setCrnNo(wrkCharge.getCrnNo()); // 鍫嗗灈鏈虹紪鍙�
+                        crnCommand.setTaskNo(wrkCharge.getWrkNo().shortValue()); // 宸ヤ綔鍙�
+                        crnCommand.setAckFinish((short) 0);  // 浠诲姟瀹屾垚纭浣�
+                        crnCommand.setTaskMode(CrnTaskModeType.STE_MOVE); // 浠诲姟妯″紡:  搴撲綅绉昏浆
+                        crnCommand.setSourcePosX(Utils.getGroupRow(steProtocol.getRow().intValue()).shortValue());     // 婧愬簱浣嶆帓
+                        crnCommand.setSourcePosY(steProtocol.getBay());     // 婧愬簱浣嶅垪
+                        crnCommand.setSourcePosZ(steProtocol.getLev());     // 婧愬簱浣嶅眰
+                        crnCommand.setDestinationPosX(Utils.getGroupRow(locMast.getLocNo()).shortValue());     // 鐩爣搴撲綅鎺�
+                        crnCommand.setDestinationPosY(locMast.getBay1().shortValue());     // 鐩爣搴撲綅鍒�
+                        crnCommand.setDestinationPosZ(locMast.getLev1().shortValue());     // 鐩爣搴撲綅灞�
+                        if (!MessageQueue.offer(SlaveType.Crn, wrkCharge.getCrnNo(), new Task(2, crnCommand))) {
+                            log.error("鍫嗗灈鏈哄懡浠や笅鍙戝け璐ワ紝鍫嗗灈鏈哄彿={}锛屼换鍔℃暟鎹�={}", wrkCharge.getCrnNo(), JSON.toJSON(crnCommand));
+                        } else {
+                            // 淇敼绌挎杞﹁繍琛屼腑鎺掑垪灞�
+                            steThread.modifyPos(Utils.getGroupRow(locMast.getLocNo()), locMast.getBay1(), locMast.getLev1());
+                            // 淇敼宸ヤ綔妗g姸鎬� 22.灏忚溅寰呮惉 => 23.鍚婅溅鎼繍
+                            Date now = new Date();
+                            wrkCharge.setWrkSts(23L);
+                            wrkCharge.setCrnStrTime(now);
+                            wrkCharge.setModiTime(now);
+                            if (!wrkChargeService.updateById(wrkCharge)) {
+                                log.error("淇敼宸ヤ綔妗g姸鎬� 22.灏忚溅寰呮惉 => 23.鍚婅溅鎼繍 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkCharge.getWrkNo());
+                            }
+                        }
+
+                    } else if (wrkCharge.getWrkSts() == 24L) {
+                        // 灏忚溅琛岄┒鑷冲厖鐢典綅
+                        if (steProtocol.statusType.equals(SteStatusType.IDLE) && steProtocol.getPakMk().equals("N")) {
+                            if (steProtocol.getChargeStatus() == 1) { continue; }
+                            // 鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
+                            SteCommand steCommand = new SteCommand();
+                            steCommand.setSteNo(wrkCharge.getSteNo()); // 绌挎杞︾紪鍙�
+                            steCommand.setTaskNo(wrkCharge.getWrkNo()); // 宸ヤ綔鍙�
+                            steCommand.setTaskMode(SteTaskModeType.findChargeByLoc(steProtocol.getRow().intValue()));
+                            if (!MessageQueue.offer(SlaveType.Ste, wrkCharge.getSteNo(), new Task(2, steCommand))) {
+                                log.error("绌挎杞﹀懡浠や笅鍙戝け璐ワ紝绌挎杞﹀彿={}锛屼换鍔℃暟鎹�={}", wrkCharge.getSteNo(), JSON.toJSON(steCommand));
+                            } else {
+                                // 淇敼宸ヤ綔妗g姸鎬� 24.灏忚溅鍒拌揪 ===> 25.灏忚溅鍘诲厖鐢�
+                                wrkCharge.setWrkSts(25L);
+                                Date now = new Date();
+                                wrkCharge.setCrnEndTime(now);
+                                wrkCharge.setModiTime(now);
+                                if (!wrkChargeService.updateById(wrkCharge)) {
+                                    log.error("淇敼鍏呯數浠诲姟鐘舵�� 24.灏忚溅鍒拌揪 ===> 25.灏忚溅鍘诲厖鐢� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkCharge.getWrkNo());
+                                }
+                            }
+                        }
+                    } else if (wrkCharge.getWrkSts() == 26) {
+                        if (steProtocol.getChargeStatus() == 0) { continue; }
+                        // 缁欒緭閫佺嚎涓嬪彂鍏呯數浠诲姟
+                        SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, 1);
+                        SteChargeType steChargeType = SteChargeType.get(wrkCharge.getLocNo());
+                        if (null != steChargeType) {
+                            if (devpThread.charge(steChargeType.ssbm - 1, true)) {
+                                // 淇敼宸ヤ綔妗g姸鎬� 26.绛夊緟鍏呯數 ===> 28.瀹屾垚鍏呯數
+                                wrkCharge.setWrkSts(28L);
+                                if (!wrkChargeService.updateById(wrkCharge)) {
+                                    log.error("淇敼鍏呯數浠诲姟鐘舵�� 26.绛夊緟鍏呯數 ===> 28.瀹屾垚鍏呯數 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkCharge.getWrkNo());
+                                } else {
+                                    steThread.setResetFlag(true);
+                                }
+                            }
+                        } else {
+                            log.error("鑾峰彇鍏呯數妗╁彿澶辫触锛岃В鏋愬簱浣嶏細{}", wrkCharge.getLocNo());
+                        }
+                    }
+                }
+            } catch (Exception e) {
+                log.error("fail", e);
+            }
+        }
+    }
 
 }

--
Gitblit v1.9.1