From c6ac4fcda65f2033dbf4d0cfb57fc32cdd3eee2f Mon Sep 17 00:00:00 2001
From: luxiaotao1123 <t1341870251@163.com>
Date: 星期三, 30 十一月 2022 14:42:09 +0800
Subject: [PATCH] #

---
 src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java |  349 +++++++++++++++++++++++++++++++++------------------------
 1 files changed, 203 insertions(+), 146 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 0d9041e..c03dcef 100644
--- a/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java
+++ b/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java
@@ -173,7 +173,7 @@
                         param.setBarcode(barcode);
                         param.setIoType(1);
                         param.setSourceStaNo(inSta.getStaNo());
-                        param.setLocType1(locTypeDto.getLocType1());
+//                        param.setLocType1(locTypeDto.getLocType1());
                         String response = new HttpHandler.Builder()
                                 .setUri(wmsUrl)
                                 .setPath("/rpc/pakin/loc/v1")
@@ -643,7 +643,7 @@
                     }
                 }
                 // 搴撲綅绉昏浆
-                this.locToLoc(crn, crnProtocol);
+//                this.locToLoc(crn, crnProtocol);
             }
         }
     }
@@ -732,9 +732,9 @@
                                         log.error("璋冩暣宸ヤ綔妗d紭鍏堢骇澶辫触锛佸伐浣滃彿={}", waitWrkMast.getWrkNo());
                                     }
                                     //20220719 Add锛屽鏋滄祬搴撲綅鐘舵�佷负P/R锛屽伐浣滅姸鎬佷负14/15,璇存槑娴呭簱浣嶅凡缁忕┖浜嗭紝鍙互鎵ц鍏ュ簱浠诲姟
-                                    continue;
                                 }
                             }
+                            continue;
                         }
                         if (shallowLoc.getLocSts().equals("F") || shallowLoc.getLocSts().equals("D")) {
                             // 姝ゆ爣璁伴伩鍏嶅娆℃墽琛岀Щ搴撲换鍔�
@@ -847,7 +847,7 @@
                     Integer steNo = this.hasCarOfIdle(wrkMast.getLocNo());
                     // 鏈夊皬杞�
                     if (steNo != null) {
-                        // 灏忚溅琛岃蛋鍒板爢鍨涙満寰呮惉绉荤偣
+                        // 灏忚溅琛岃蛋鍒板緟鏈轰綅
                         if (wrkMast.getWrkSts() == 2L && wrkMast.getSteNo() == null) {
                             // 娌℃湁鍏朵粬浠诲姟
                             if (null == wrkMastMapper.selectPakin(slave.getId(), steNo)) {
@@ -974,7 +974,7 @@
                 wrkMastMapper.updateById(wrkMast);
 
                 // 鍒ゆ柇鏄惁涓虹┛姊簱
-                if (!locMastService.isShuttle(wrkMast.getLocNo())) {
+                if (!locMastService.isShuttle(wrkMast.getSourceLocNo())) {
 
                     // 鍙屾繁搴撲綅涓旀祬搴撲綅鏈夎揣锛屽垯闇�鍏堝娴呭簱浣嶈繘琛屽簱浣嶇Щ杞�
                     if (Utils.isDeepLoc(slaveProperties, wrkMast.getSourceLocNo())) {
@@ -1174,6 +1174,7 @@
     /**
      * 搴撲綅绉昏浆
      */
+    @Deprecated
     public void locToLoc(CrnSlave slave, CrnProtocol crnProtocol){
         // 鑾峰彇宸ヤ綔妗d俊鎭�
         WrkMast wrkMast = wrkMastMapper.selectLocMove(slave.getId());
@@ -1346,8 +1347,7 @@
     }
 
     /**
-     * 璁╁皬杞︿粠 杩滅偣 ====>> 寰呮満
-     *  绛夊緟鍫嗗灈鏈烘惉杩�
+     * 璁╁皬杞﹁璧拌嚦寰呮満浣�
      */
     public void letCarBeWaiting(WrkMast wrkMast, Integer steNo, String locNo) {
         // 鑾峰彇绌挎杞︿俊鎭�
@@ -1356,24 +1356,35 @@
         if (steProtocol == null) { return; }
         if (steProtocol.isIdle()) {
 
-            // 鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
-            SteCommand steCommand = new SteCommand();
-            steCommand.setSteNo(steNo); // 绌挎杞︾紪鍙�
-            steCommand.setTaskNo(wrkMast.getWrkNo()); // 宸ヤ綔鍙�
-            steCommand.setTaskMode(SteTaskModeType.findWaiting(steProtocol.getRow().intValue())); // 浠诲姟妯″紡:  鍘昏繎鐐� 绛夊緟鍫嗗灈鏈哄弶鍙�
-
-            steCommand.setRow(Utils.getGroupRow(steProtocol.getRow().intValue(), true).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 {
+            // 濡傛灉澶勪簬寰呮満浣�
+            if (steProtocol.locaType.equals(SteLocaType.A_WAITING) || steProtocol.locaType.equals(SteLocaType.B_WAITING)) {
                 // 淇敼宸ヤ綔妗g姸鎬� 缁戝畾绌挎杞�
+                wrkMast.setWrkSts(3L);
                 wrkMast.setSteNo(steNo);
                 wrkMast.setModiTime(new Date());
                 if (wrkMastMapper.updateById(wrkMast) == 0) {
                     log.error("淇敼宸ヤ綔妗g姸鎬� 缁戝畾绌挎杞� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
+                }
+            } else {
+                // 鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
+                SteCommand steCommand = new SteCommand();
+                steCommand.setSteNo(steNo); // 绌挎杞︾紪鍙�
+                steCommand.setTaskNo(wrkMast.getWrkNo()); // 宸ヤ綔鍙�
+                steCommand.setTaskMode(SteTaskModeType.findWaiting(steProtocol.getRow().intValue())); // 浠诲姟妯″紡:  琛岃蛋鑷冲緟鏈轰綅
+
+                steCommand.setRow(Utils.getGroupRow(steProtocol.getRow().intValue(), true).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());
+                    }
                 }
             }
         }
@@ -2484,7 +2495,10 @@
      */
     @SuppressWarnings("serial")
     public synchronized void loopSteCharge() {
-        if (null != wrkChargeService.selectWorking(null, WrkChargeType.reset.toString())) {
+        if (null != wrkChargeService.selectWorking(null, WrkChargeType.reset)) {
+            return;
+        }
+        if (null != wrkChargeService.selectWorking(null, WrkChargeType.charge)) {
             return;
         }
         SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, 1);
@@ -2509,7 +2523,7 @@
                 if (steProtocol.getCharge() > Float.parseFloat(basSte.getChargeLine())) {
                     continue;
                 }
-                WrkCharge wrkCharge = wrkChargeService.selectWorking(null, WrkChargeType.charge.toString());
+                WrkCharge wrkCharge = wrkChargeService.selectWorking(null, WrkChargeType.charge);
 
                 if (wrkCharge == null && steProtocol.getChargeStatus() == 0) {
                     // 瀵绘壘绌洪棽鍏呯數妗�
@@ -2517,23 +2531,29 @@
                     do {
                         String locNo;
                         if (!devpThread.charge0) {
-                            locNo = SteChargeType.FIRST.locNo;
-                            if (basSteService.hasCarOfLocNo(locNo) == null) {
-                                steCharge = SteChargeType.FIRST;
+                            SteChargeType first = SteChargeType.FIRST;
+                            locNo = first.locNo;
+                            if (basSteService.hasCarOfLocNo(locNo) == null
+                                && wrkChargeService.selectWorkingOfCharge(first.ssbm) != null) {
+                                steCharge = first;
                                 break;
                             }
                         }
                         if (!devpThread.charge1) {
-                            locNo = SteChargeType.SECOND.locNo;
-                            if (basSteService.hasCarOfLocNo(locNo) == null) {
-                                steCharge = SteChargeType.SECOND;
+                            SteChargeType second = SteChargeType.SECOND;
+                            locNo = second.locNo;
+                            if (basSteService.hasCarOfLocNo(locNo) == null
+                                && wrkChargeService.selectWorkingOfCharge(second.ssbm) != null) {
+                                steCharge = second;
                                 break;
                             }
                         }
                         if (!devpThread.charge2) {
-                            locNo = SteChargeType.THIRD.locNo;
-                            if (basSteService.hasCarOfLocNo(locNo) == null) {
-                                steCharge = SteChargeType.THIRD;
+                            SteChargeType third = SteChargeType.THIRD;
+                            locNo = third.locNo;
+                            if (basSteService.hasCarOfLocNo(locNo) == null
+                                && wrkChargeService.selectWorkingOfCharge(third.ssbm) != null) {
+                                steCharge = third;
                                 break;
                             }
                         }
@@ -2547,6 +2567,7 @@
                     String chargeLocNo = steCharge.locNo;
                     wrkCharge = new WrkCharge();
                     wrkCharge.setSteNo(ste.getId());
+                    wrkCharge.setCharge(steCharge.ssbm);
                     wrkCharge.setWrkNo(commonService.getChargeWorkNo(4));
                     wrkCharge.setWrkSts(21L);   // 21.鍑嗗鍏呯數
                     wrkCharge.setCrnNo(2);  // 鍥哄畾2鍙峰爢鍨涙満
@@ -2573,145 +2594,179 @@
                         this.letCarBeWaiting(wrkCharge, ste.getId());
                     }
 
-                } else {
-                    // filter
-                    if (wrkCharge == null || (wrkCharge.getWrkSts() < 28 && steProtocol.getChargeStatus() == 1)) {
-                        continue;
-                    }
+                    break;
+                }
+            } catch (Exception e) {
+                TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
+                log.error("loopSteCharge fail", e);
+            }
+        }
+    }
 
-                    // 22.灏忚溅寰呮惉
-                    if (wrkCharge.getWrkSts() == 22) {
+    /**
+     * 鎵ц灏忚溅鍏呯數浠诲姟
+     */
+    public synchronized void executeSteCharge() {
+        WrkCharge wrkCharge = wrkChargeService.selectWorking(null, WrkChargeType.charge);
+        if (null == wrkCharge) { return; }
+        Integer steNo = wrkCharge.getSteNo();
+        SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, steNo);
+        SteProtocol steProtocol = steThread.getSteProtocol();
+        BasSte basSte = basSteService.selectById(steNo);
+        if (Cools.isEmpty(steProtocol, basSte)) { return; }
+        if (steProtocol.getMode() == 0
+                || !steProtocol.statusType.equals(SteStatusType.IDLE)
+                || basSte.getPakMk().equals("Y")
+                || basSte.getAutoCharge().equals("N")
+//                || steProtocol.getChargeStatus() == 1
+        ) {
+            return;
+        }
+        if (!steProtocol.isEnable()) {
+            return;
+        }
+        if (steProtocol.getCharge() > Float.parseFloat(basSte.getChargeLine())) {
+            wrkCharge.setWrkSts(30L);
+            wrkChargeMapper.updateById(wrkCharge);
+            return;
+        }
+        try {
+            // filter
+            if (wrkCharge.getWrkSts() < 28 && steProtocol.getChargeStatus() == 1) {
+                return;
+            }
 
-                        // 鎼皬杞﹁嚦灏忚溅璧板悜閫氶亾
-                        List<String> channel = slaveProperties.getChannel();
-                        for (String channelLocNo : channel) {
-                            Integer otherSte = existOtherSte(channelLocNo, wrkCharge.getSteNo());
-                            if (null != otherSte) {
-                                log.warn("{}鍙峰皬杞︾Щ鍏}搴撲綅缁勫け璐ワ紝鍘熷洜锛氬瓨鍦▄}鍙风┛姊溅锛�", wrkCharge.getSteNo(), channelLocNo, otherSte);
-                            } else {
-                                LocMast channelLoc = locMastService.selectById(channelLocNo);
+            // 22.灏忚溅寰呮惉
+            if (wrkCharge.getWrkSts() == 22) {
 
-                                CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn, wrkCharge.getCrnNo());
-                                CrnProtocol crnProtocol = crnThread.getCrnProtocol();
-                                if (crnProtocol == null) { continue; }
-                                // 鍙湁褰撳爢鍨涙満绌洪棽 骞朵笖 鏃犱换鍔℃椂鎵嶇户缁墽琛�
-                                if (crnProtocol.getStatusType() == CrnStatusType.IDLE && crnProtocol.getTaskNo() == 0 && crnProtocol.getModeType() == CrnModeType.AUTO) {
-                                    // 鍫嗗灈鏈哄懡浠や笅鍙戝尯 --------------------------------------------------------------------------
-                                    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(), true).shortValue());     // 婧愬簱浣嶆帓
-                                    crnCommand.setSourcePosY(steProtocol.getBay());     // 婧愬簱浣嶅垪
-                                    crnCommand.setSourcePosZ(steProtocol.getLev());     // 婧愬簱浣嶅眰
-                                    crnCommand.setDestinationPosX(Utils.getGroupRow(channelLoc.getLocNo(), true).shortValue());     // 鐩爣搴撲綅鎺�
-                                    crnCommand.setDestinationPosY(channelLoc.getBay1().shortValue());     // 鐩爣搴撲綅鍒�
-                                    crnCommand.setDestinationPosZ(channelLoc.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(channelLoc.getLocNo(), true), channelLoc.getBay1(), channelLoc.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());
-                                        }
-                                    }
-                                    break;
-                                }
+                // 鎼皬杞﹁嚦灏忚溅璧板悜閫氶亾
+                List<String> channel = slaveProperties.getChannel();
+                for (String channelLocNo : channel) {
+                    Integer otherSte = existOtherSte(channelLocNo, wrkCharge.getSteNo());
+                    if (null != otherSte) {
+                        log.warn("{}鍙峰皬杞︾Щ鍏}搴撲綅缁勫け璐ワ紝鍘熷洜锛氬瓨鍦▄}鍙风┛姊溅锛�", wrkCharge.getSteNo(), channelLocNo, otherSte);
+                    } else {
+                        LocMast channelLoc = locMastService.selectById(channelLocNo);
 
-                            }
-                        }
-
-                    } 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.GO_ORIGIN);  // 鍘诲彸绔�
-
-                            steCommand.setRow(Utils.getGroupRow(steProtocol.getRow().intValue(), false).shortValue());
-                            steCommand.setBay(steProtocol.getBay());
-                            steCommand.setLev(steProtocol.getLev());
-                            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) {
-                        // 鍥哄畾鍫嗗灈鏈�
-                        int crnNo = 1;
-                        // 鍏呯數浣�
-                        LocMast chargeLoc = locMastService.selectById(wrkCharge.getLocNo());
-
-                        CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn, crnNo);
+                        CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn, wrkCharge.getCrnNo());
                         CrnProtocol crnProtocol = crnThread.getCrnProtocol();
                         if (crnProtocol == null) { continue; }
                         // 鍙湁褰撳爢鍨涙満绌洪棽 骞朵笖 鏃犱换鍔℃椂鎵嶇户缁墽琛�
                         if (crnProtocol.getStatusType() == CrnStatusType.IDLE && crnProtocol.getTaskNo() == 0 && crnProtocol.getModeType() == CrnModeType.AUTO) {
                             // 鍫嗗灈鏈哄懡浠や笅鍙戝尯 --------------------------------------------------------------------------
                             CrnCommand crnCommand = new CrnCommand();
-                            crnCommand.setCrnNo(crnNo); // 鍫嗗灈鏈虹紪鍙�
+                            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(), false).shortValue());     // 婧愬簱浣嶆帓
+                            crnCommand.setSourcePosX(Utils.getGroupRow(steProtocol.getRow().intValue(), true).shortValue());     // 婧愬簱浣嶆帓
                             crnCommand.setSourcePosY(steProtocol.getBay());     // 婧愬簱浣嶅垪
                             crnCommand.setSourcePosZ(steProtocol.getLev());     // 婧愬簱浣嶅眰
-                            crnCommand.setDestinationPosX(chargeLoc.getRow1().shortValue());     // 鐩爣搴撲綅鎺�
-                            crnCommand.setDestinationPosY(chargeLoc.getBay1().shortValue());     // 鐩爣搴撲綅鍒�
-                            crnCommand.setDestinationPosZ(chargeLoc.getLev1().shortValue());     // 鐩爣搴撲綅灞�
-                            if (!MessageQueue.offer(SlaveType.Crn, crnNo, new Task(2, crnCommand))) {
-                                log.error("鍫嗗灈鏈哄懡浠や笅鍙戝け璐ワ紝鍫嗗灈鏈哄彿={}锛屼换鍔℃暟鎹�={}", crnNo, JSON.toJSON(crnCommand));
+                            crnCommand.setDestinationPosX(Utils.getGroupRow(channelLoc.getLocNo(), true).shortValue());     // 鐩爣搴撲綅鎺�
+                            crnCommand.setDestinationPosY(channelLoc.getBay1().shortValue());     // 鐩爣搴撲綅鍒�
+                            crnCommand.setDestinationPosZ(channelLoc.getLev1().shortValue());     // 鐩爣搴撲綅灞�
+                            if (!MessageQueue.offer(SlaveType.Crn, wrkCharge.getCrnNo(), new Task(2, crnCommand))) {
+                                log.error("鍫嗗灈鏈哄懡浠や笅鍙戝け璐ワ紝鍫嗗灈鏈哄彿={}锛屼换鍔℃暟鎹�={}", wrkCharge.getCrnNo(), JSON.toJSON(crnCommand));
                             } else {
                                 // 淇敼绌挎杞﹁繍琛屼腑鎺掑垪灞�
-                                steThread.modifyPos(chargeLoc.getRow1(), chargeLoc.getBay1(), chargeLoc.getLev1());
-                                // 淇敼宸ヤ綔妗g姸鎬� 26.绛夊緟鍏呯數 => 27.鏀捐嚦鍏呯數浣�
+                                steThread.modifyPos(Utils.getGroupRow(channelLoc.getLocNo(), true), channelLoc.getBay1(), channelLoc.getLev1());
+                                // 淇敼宸ヤ綔妗g姸鎬� 22.灏忚溅寰呮惉 => 23.鍚婅溅鎼繍
                                 Date now = new Date();
-                                wrkCharge.setWrkSts(27L);
+                                wrkCharge.setWrkSts(23L);
                                 wrkCharge.setCrnStrTime(now);
                                 wrkCharge.setModiTime(now);
                                 if (!wrkChargeService.updateById(wrkCharge)) {
-                                    log.error("淇敼宸ヤ綔妗g姸鎬� 26.绛夊緟鍏呯數 => 27.鏀捐嚦鍏呯數浣� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkCharge.getWrkNo());
+                                    log.error("淇敼宸ヤ綔妗g姸鎬� 22.灏忚溅寰呮惉 => 23.鍚婅溅鎼繍 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkCharge.getWrkNo());
                                 }
                             }
+                            break;
                         }
-                    } else if (wrkCharge.getWrkSts() == 28L) {
-                        // 绌挎杞︿笅鍙戝厖鐢典换鍔�
-                        SteCommand steCommand = new SteCommand();
-                        steCommand.setSteNo(wrkCharge.getSteNo()); // 绌挎杞︾紪鍙�
-                        steCommand.setTaskNo(wrkCharge.getWrkNo()); // 宸ヤ綔鍙�
-                        steCommand.setTaskMode(SteTaskModeType.CHARGE_LEFT); // 浠诲姟妯″紡: 鍏呯數
-                        if (!MessageQueue.offer(SlaveType.Ste, wrkCharge.getSteNo(), new Task(2, steCommand))) {
-                            log.error("绌挎杞﹀懡浠や笅鍙戝け璐ワ紝绌挎杞﹀彿={}锛屼换鍔℃暟鎹�={}", wrkCharge.getSteNo(), JSON.toJSON(steCommand));
-                        } else {
-                            // 28.鍏呯數灏辩华 ===>> 29.寮�濮嬪厖鐢�
-                            wrkCharge.setWrkSts(29L);
-                            if (!wrkChargeService.updateById(wrkCharge)) {
-                                log.error("淇敼鍏呯數浠诲姟鐘舵�� 28.鍏呯數灏辩华 ===>> 29.寮�濮嬪厖鐢� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkCharge.getWrkNo());
-                            }
+
+                    }
+                }
+
+            } else if (wrkCharge.getWrkSts() == 24L) {
+                // 灏忚溅琛岄┒閫氶亾
+                if (steProtocol.statusType.equals(SteStatusType.IDLE) && steProtocol.getPakMk().equals("N")) {
+                    if (steProtocol.getChargeStatus() == 1) { return; }
+                    // 鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
+                    SteCommand steCommand = new SteCommand();
+                    steCommand.setSteNo(wrkCharge.getSteNo()); // 绌挎杞︾紪鍙�
+                    steCommand.setTaskNo(wrkCharge.getWrkNo()); // 宸ヤ綔鍙�
+                    steCommand.setTaskMode(SteTaskModeType.GO_ORIGIN);  // 鍘诲彸绔�
+
+                    steCommand.setRow(Utils.getGroupRow(steProtocol.getRow().intValue(), false).shortValue());
+                    steCommand.setBay(steProtocol.getBay());
+                    steCommand.setLev(steProtocol.getLev());
+                    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());
                         }
                     }
                 }
-            } catch (Exception e) {
-                log.error("fail", e);
+            } else if (wrkCharge.getWrkSts() == 26) {
+                // 鍥哄畾鍫嗗灈鏈�
+                int crnNo = 1;
+                // 鍏呯數浣�
+                LocMast chargeLoc = locMastService.selectById(wrkCharge.getLocNo());
+
+                CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn, crnNo);
+                CrnProtocol crnProtocol = crnThread.getCrnProtocol();
+                if (crnProtocol == null) { return; }
+                // 鍙湁褰撳爢鍨涙満绌洪棽 骞朵笖 鏃犱换鍔℃椂鎵嶇户缁墽琛�
+                if (crnProtocol.getStatusType() == CrnStatusType.IDLE && crnProtocol.getTaskNo() == 0 && crnProtocol.getModeType() == CrnModeType.AUTO) {
+                    // 鍫嗗灈鏈哄懡浠や笅鍙戝尯 --------------------------------------------------------------------------
+                    CrnCommand crnCommand = new CrnCommand();
+                    crnCommand.setCrnNo(crnNo); // 鍫嗗灈鏈虹紪鍙�
+                    crnCommand.setTaskNo(wrkCharge.getWrkNo().shortValue()); // 宸ヤ綔鍙�
+                    crnCommand.setAckFinish((short) 0);  // 浠诲姟瀹屾垚纭浣�
+                    crnCommand.setTaskMode(CrnTaskModeType.STE_MOVE); // 浠诲姟妯″紡:  搴撲綅绉昏浆
+                    crnCommand.setSourcePosX(Utils.getGroupRow(steProtocol.getRow().intValue(), false).shortValue());     // 婧愬簱浣嶆帓
+                    crnCommand.setSourcePosY(steProtocol.getBay());     // 婧愬簱浣嶅垪
+                    crnCommand.setSourcePosZ(steProtocol.getLev());     // 婧愬簱浣嶅眰
+                    crnCommand.setDestinationPosX(chargeLoc.getRow1().shortValue());     // 鐩爣搴撲綅鎺�
+                    crnCommand.setDestinationPosY(chargeLoc.getBay1().shortValue());     // 鐩爣搴撲綅鍒�
+                    crnCommand.setDestinationPosZ(chargeLoc.getLev1().shortValue());     // 鐩爣搴撲綅灞�
+                    if (!MessageQueue.offer(SlaveType.Crn, crnNo, new Task(2, crnCommand))) {
+                        log.error("鍫嗗灈鏈哄懡浠や笅鍙戝け璐ワ紝鍫嗗灈鏈哄彿={}锛屼换鍔℃暟鎹�={}", crnNo, JSON.toJSON(crnCommand));
+                    } else {
+                        // 淇敼绌挎杞﹁繍琛屼腑鎺掑垪灞�
+                        steThread.modifyPos(chargeLoc.getRow1(), chargeLoc.getBay1(), chargeLoc.getLev1());
+                        // 淇敼宸ヤ綔妗g姸鎬� 26.绛夊緟鍏呯數 => 27.鏀捐嚦鍏呯數浣�
+                        Date now = new Date();
+                        wrkCharge.setWrkSts(27L);
+                        wrkCharge.setCrnStrTime(now);
+                        wrkCharge.setModiTime(now);
+                        if (!wrkChargeService.updateById(wrkCharge)) {
+                            log.error("淇敼宸ヤ綔妗g姸鎬� 26.绛夊緟鍏呯數 => 27.鏀捐嚦鍏呯數浣� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkCharge.getWrkNo());
+                        }
+                    }
+                }
+            } else if (wrkCharge.getWrkSts() == 28L) {
+                // 绌挎杞︿笅鍙戝厖鐢典换鍔�
+                SteCommand steCommand = new SteCommand();
+                steCommand.setSteNo(wrkCharge.getSteNo()); // 绌挎杞︾紪鍙�
+                steCommand.setTaskNo(wrkCharge.getWrkNo()); // 宸ヤ綔鍙�
+                steCommand.setTaskMode(SteTaskModeType.CHARGE_LEFT); // 浠诲姟妯″紡: 鍏呯數
+                if (!MessageQueue.offer(SlaveType.Ste, wrkCharge.getSteNo(), new Task(2, steCommand))) {
+                    log.error("绌挎杞﹀懡浠や笅鍙戝け璐ワ紝绌挎杞﹀彿={}锛屼换鍔℃暟鎹�={}", wrkCharge.getSteNo(), JSON.toJSON(steCommand));
+                } else {
+                    // 28.鍏呯數灏辩华 ===>> 29.寮�濮嬪厖鐢�
+                    wrkCharge.setWrkSts(29L);
+                    if (!wrkChargeService.updateById(wrkCharge)) {
+                        log.error("淇敼鍏呯數浠诲姟鐘舵�� 28.鍏呯數灏辩华 ===>> 29.寮�濮嬪厖鐢� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkCharge.getWrkNo());
+                    }
+                }
             }
+        } catch (Exception e) {
+            log.error("executeSteCharge fail", e);
         }
     }
 
@@ -2720,7 +2775,8 @@
      */
     public synchronized void queryChargeLocOfComplete() {
         // 涓庡厖鐢典换鍔′笉鍚屾杩涜
-        if (null != wrkChargeService.selectWorking(null, WrkChargeType.charge.toString())) { return; }
+        if (null != wrkChargeService.selectWorking(null, WrkChargeType.charge)) { return; }
+        if (null != wrkChargeService.selectWorking(null, WrkChargeType.reset)) { return; }
         SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, 1);
         // 妫�绱㈠厖鐢垫々
         for (SteChargeType value : SteChargeType.values()) {
@@ -2757,7 +2813,7 @@
                     continue;
                 }
 
-                WrkCharge wrkCharge = wrkChargeService.selectWorking(steNo, WrkChargeType.reset.toString());
+                WrkCharge wrkCharge = wrkChargeService.selectWorking(steNo, WrkChargeType.reset);
 
                 if (wrkCharge == null) {
                     // 寮�濮嬬┛姊溅澶嶄綅浠诲姟
@@ -2773,6 +2829,8 @@
                     wrkCharge.setAppeTime(new Date());
                     if (!wrkChargeService.insert(wrkCharge)) {
                         log.error("淇濆瓨{}鍙风┛姊溅澶嶄綅浠诲姟澶辫触!!!", steNo);
+                    } else {
+                        break;
                     }
                 }
             }
@@ -2783,7 +2841,7 @@
      * 灏忚溅浠庡厖鐢垫々 鑷� 寰呮満搴撲綅
      */
     public synchronized void steFromChargeToIdleLoc() {
-        WrkCharge wrkCharge = wrkChargeService.selectWorking(null, WrkChargeType.reset.toString());
+        WrkCharge wrkCharge = wrkChargeService.selectWorking(null, WrkChargeType.reset);
         if (wrkCharge == null) { return; }
         SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, wrkCharge.getSteNo());
         SteProtocol steProtocol = steThread.getSteProtocol();
@@ -2931,7 +2989,6 @@
                             }
                         }
                     }
-
 
                     if (null != loc) {
                         break;

--
Gitblit v1.9.1