From c4355edf683197a67e127c796e8f93650cc2a302 Mon Sep 17 00:00:00 2001
From: Junjie <fallin.jie@qq.com>
Date: 星期一, 19 六月 2023 19:02:38 +0800
Subject: [PATCH] 充电任务优化

---
 src/main/java/com/zy/core/model/protocol/ShuttleProtocol.java |   24 +++-
 src/main/java/com/zy/core/enums/ShuttleChargeType.java        |    1 
 src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java   |  251 ++++++++++++++++++++++++++++---------------------
 src/main/java/com/zy/core/MainProcess.java                    |    4 
 src/main/java/com/zy/core/model/protocol/LiftProtocol.java    |    2 
 src/main/java/com/zy/core/thread/SiemensDevpThread.java       |    4 
 6 files changed, 166 insertions(+), 120 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 28d2612..0d68a9c 100644
--- a/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java
+++ b/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java
@@ -4,6 +4,7 @@
 import com.alibaba.fastjson.JSONObject;
 import com.baomidou.mybatisplus.mapper.EntityWrapper;
 import com.core.common.Cools;
+import com.core.common.SpringUtils;
 import com.core.exception.CoolException;
 import com.zy.asrs.entity.*;
 import com.zy.asrs.mapper.*;
@@ -768,7 +769,10 @@
                                 //涓嶅悓灞傦紝灏嗙洰鏍囧簱浣嶅垎閰嶆垚鎻愬崌鏈哄簱浣嶅彿
 
                                 //灏忚溅绉诲姩鍒版彁鍗囨満鍙o紝璁$畻璺緞
-                                List<ShuttleCommand> commands = this.shuttleAssignCommand(currentLocNo, liftSiteLocNo, ShuttleTaskModeType.PAK_IN.id, assignCommand, shuttleThread);
+                                List<ShuttleCommand> commands = this.shuttleAssignCommand(currentLocNo, liftSiteLocNo, NavigationMapType.NONE.id, assignCommand, shuttleThread);
+                                if (commands == null) {
+                                    continue;//鏈壘鍒拌矾寰�
+                                }
 
                                 //鑾峰彇褰撳墠灏忚溅鎵�鍦ㄦゼ灞傜殑绔欑偣淇℃伅
                                 BasDevp basDevp = basDevpService.queryByLocNo(liftSiteLocNo);
@@ -1069,6 +1073,9 @@
 
                             //灏忚溅鍒版彁鍗囨満鍙f寚浠�
                             List<ShuttleCommand> commands = this.shuttleAssignCommand(currentLocNo, liftSiteLocNo, ShuttleTaskModeType.PAK_IN.id, assignCommand, shuttleThread);
+                            if (commands == null) {
+                                continue;//鏈壘鍒拌矾寰�
+                            }
                             shuttleProtocol.setLocNo(liftSiteLocNo);
 
                             //鑾峰彇褰撳墠灏忚溅鎵�鍦ㄦゼ灞傜殑绔欑偣淇℃伅
@@ -1086,6 +1093,9 @@
                         }
                     } else if (wrkMast.getWrkSts() == 25) {
                         List<ShuttleCommand> commands = this.shuttleAssignCommand(currentLocNo, wrkMast.getSourceLocNo(), liftSiteLocNo, assignCommand, shuttleThread);
+                        if (commands == null) {
+                            continue;//鏈壘鍒拌矾寰�
+                        }
                         //姝ゆ椂杞﹀湪鎻愬崌鏈哄唴閮紝闇�瑕佸涓嬭揪涓�姝ユ寚浠よ杞︾Щ鍔ㄥ埌鎻愬崌鏈哄彛
                         BasDevp basDevp = basDevpService.selectById(109);//鑾峰彇鎻愬崌鏈轰俊鎭�
                         short startCode = Short.parseShort(basDevp.getQrCodeValue());//鎻愬崌鏈轰簩缁寸爜
@@ -1144,49 +1154,7 @@
                 //宸ヤ綔妗d笉鍚屾ゼ灞傜殑绌挎杞�
                 diffLev.add(shuttleThread);
             }
-//
-//            //鏇存柊褰撳墠鏈�杩戠殑鍥涘悜绌挎杞�
-//            if (recentShuttle == null) {
-//                recentShuttle = shuttleThread;
-//            }else {
-//                ShuttleProtocol recentShuttleProtocol = recentShuttle.getShuttleProtocol();//鐩墠鏈�杩戠┛姊溅
-//                String recentShuttleLocNo = recentShuttleProtocol.getCurrentLocNo();//浜岀淮鐮佸搴斿簱浣嶅彿
-//                String recentShuttleLocNoLay = recentShuttleLocNo.substring(recentShuttleLocNo.length() - 2, recentShuttleLocNo.length());//搴撲綅鍙峰搴斿眰楂�
-//
-//                int recentShuttleLocNoLayInt = Integer.parseInt(recentShuttleLocNoLay);
-//                int i = Math.abs(lev - recentShuttleLocNoLayInt);//宸ヤ綔妗fゼ灞傚噺鏈�杩戠┛姊溅妤煎眰锛屽彇缁濆鍊�
-//                int j = Math.abs(lev - shuttleLocNoLey);//宸ヤ綔妗fゼ灞傚噺褰撳墠绌挎杞︽ゼ灞傦紝鍙栫粷瀵瑰��
-//                if (i < j) {
-//                    //鏇存柊鏈�杩戠┛姊溅
-//                    recentShuttle = shuttleThread;
-//                } else if (i == j) {
-//                    //妤煎眰鐩稿悓鎯呭喌
-//                    //鎵捐窛绂诲嚭搴撶偣鏈�杩戠殑杞�
-//
-//                    if (!(recentShuttleProtocol.isIdle() && shuttleProtocol.isIdle())) {
-//                        //鍙鏈変竴杈嗚溅涓嶆槸绌洪棽鍒欎笉杩涜璋冨害
-//                        map.put("sameLay", false);//涓嶅悓灞�
-//                        map.put("result", null);
-//                        return map;
-//                    }
-//
-//                    //鑾峰彇鎻愬崌鏈�
-//                    LiftSlave liftSlave = slaveProperties.getLift().get(0);
-//                    //鎻愬崌鏈哄簱浣嶅彿
-//                    String recentLiftLocNo = liftSlave.getLiftLocNo(recentShuttleLocNoLayInt);
-//                    String shuttleLiftLocNo = liftSlave.getLiftLocNo(shuttleLocNoLey);
-//
-//                    //褰撳墠鏈�杩戝洓鍚戠┛姊溅鍒版彁鍗囨満璺緞
-//                    List<NavigateNode> recentShuttlePath = NavigateUtils.calc(recentShuttleLocNo, recentLiftLocNo, ShuttleTaskModeType.PAK_IN.id);
-//                    //褰撳墠妤煎眰鍥涘悜绌挎杞﹀埌鎻愬崌鏈鸿矾寰�
-//                    List<NavigateNode> shuttlePath = NavigateUtils.calc(shuttleLocNo, shuttleLiftLocNo, ShuttleTaskModeType.PAK_IN.id);
-//                    //鍒ゆ柇鍝竴涓矾寰勬渶鐭�
-//                    if (shuttlePath.size() < recentShuttlePath.size()) {
-//                        //濡傛灉褰撳墠妤煎眰鐨勮溅璺緞鏇村皬锛屽垯鏇存柊鏈�杩戠┛姊溅
-//                        recentShuttle = shuttleThread;
-//                    }
-//                }
-//            }
+
         }
 
         if (sameLev.size() > 0) {
@@ -1652,6 +1620,31 @@
                     }
                 }
 
+                //鏌ヨ鏄惁鏈夊厖鐢典换鍔�
+                WrkCharge wrkCharge = wrkChargeMapper.selectByWorkNo(liftProtocol.getTaskNo().intValue());
+                if (wrkCharge != null) {
+                    switch (wrkCharge.getWrkSts().intValue()) {
+                        case 54://鎻愬崌鏈烘惉杩愪腑
+                            wrkCharge.setWrkSts(55L);//鎻愬崌鏈烘惉杩愬畬鎴�
+                            break;
+                        default:
+                    }
+
+                    if (wrkChargeMapper.updateById(wrkCharge) > 0) {
+                        //璁剧疆鎻愬崌鏈轰负绌洪棽鐘舵��
+                        liftProtocol.setProtocolStatus(LiftProtocolStatusType.IDLE);
+                        //浠诲姟鍙锋竻闆�
+                        liftProtocol.setTaskNo((short) 0);
+                        //鏍囪澶嶄綅
+                        liftProtocol.setPakMk(true);
+                        //浠诲姟鎸囦护娓呴浂
+                        liftProtocol.setAssignCommand(null);
+                        News.info("鎻愬崌鏈哄凡纭涓斾换鍔″畬鎴愮姸鎬�,澶嶄綅銆傛彁鍗囨満鍙�={}", liftProtocol.getLiftNo());
+                    } else {
+                        News.error("鎻愬崌鏈哄凡纭涓斾换鍔″畬鎴愮姸鎬�,澶嶄綅澶辫触锛屼絾鏈壘鍒板伐浣滄。銆傛彁鍗囨満鍙�={}锛屽伐浣滃彿={}", liftProtocol.getLiftNo(), liftProtocol.getTaskNo());
+                    }
+                }
+
                 //涓嶆槸鍏ュ嚭搴撹皟搴︿换鍔°�佸伐浣滄。浠诲姟锛岃繘琛屾彁鍗囨満鐨勫浣�
                 if (liftProtocol.getAssignCommand() != null) {
                     //璁剧疆鎻愬崌鏈轰负绌洪棽鐘舵��
@@ -1663,11 +1656,6 @@
                     //浠诲姟鎸囦护娓呴浂
                     liftProtocol.setAssignCommand(null);
                     News.info("鎻愬崌鏈哄凡纭涓斾换鍔″畬鎴愮姸鎬�,澶嶄綅銆傛彁鍗囨満鍙�={}", liftProtocol.getLiftNo());
-//                    LiftAssignCommand assignCommand = liftProtocol.getAssignCommand();
-//                    if (!assignCommand.getAuto()) {
-//                        //鎵嬪姩鍛戒护
-//
-//                    }
                 }
 
             }
@@ -2364,19 +2352,10 @@
                 }
 
                 ShuttleChargeType shuttleCharge = null;
-                String locNo;
                 for (ShuttleChargeType chargeType : ShuttleChargeType.values()) {
-                    switch (chargeType.id) {
-                        case 1:
-                            if (devpThread.charge0 == false) {
-                                ShuttleChargeType first = ShuttleChargeType.FIRST;
-                                locNo = first.locNo;
-                                if (wrkChargeService.selectWorkingOfCharge(first.id) == null) {
-                                    shuttleCharge = first;
-                                }
-                            }
-                            break;
-                        default:
+                    if (wrkChargeService.selectWorkingOfCharge(chargeType.id) == null) {
+                        shuttleCharge = chargeType;
+                        break;
                     }
                 }
 
@@ -2416,7 +2395,6 @@
             return;
         }
 
-
         ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkCharge.getShuttleNo());
         if (shuttleThread == null) {
             return;
@@ -2429,17 +2407,22 @@
         //褰撳墠绌挎杞﹀簱浣嶅彿
         String currentLocNo = shuttleProtocol.getCurrentLocNo();
         //灏忚溅褰撳墠灞傞珮
-        Integer currentLev = currentLocNo == null ? 0 : Integer.parseInt(currentLocNo.substring(currentLocNo.length() - 2, currentLocNo.length()));
+        Integer currentLev = currentLocNo == null ? 0 : Utils.getLev(currentLocNo);
         //鑾峰彇鎻愬崌鏈�
-        LiftSlave liftSlave = slaveProperties.getLift().get(0);
-        //鎻愬崌鏈哄簱浣嶅彿
-        String liftLocNo = liftSlave.getLiftLocNo(currentLev);
+        LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, 1);
+        if (liftThread == null) {
+            return;
+        }
+        LiftProtocol liftProtocol = liftThread.getLiftProtocol();
+        if (liftProtocol == null) {
+            return;
+        }
         //鍏呯數搴撲綅鍙�
         String chargeLocNo = wrkCharge.getLocNo();
         //鍏呯數搴撲綅灞傞珮
-        Integer chargeLocNoLev = Integer.parseInt(chargeLocNo.substring(chargeLocNo.length() - 2, chargeLocNo.length()));
+        Integer chargeLocNoLev = Utils.getLev(chargeLocNo);
 
-        if (wrkCharge.getWrkSts() == 51 || wrkCharge.getWrkSts() == 55) {
+        if (wrkCharge.getWrkSts() == 51) {
             if (currentLev == chargeLocNoLev) {
                 //鍚屼竴灞傛棤闇�缁忚繃鎻愬崌鏈�
                 //鐩存帴璁$畻杞﹀埌鍏呯數搴撲綅
@@ -2447,7 +2430,10 @@
                 ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
 
                 //鑾峰彇灏忚溅鍒板厖鐢靛簱浣嶈矾寰勬寚浠�
-                List<ShuttleCommand> commands = this.shuttleAssignCommand(currentLocNo, chargeLocNo, ShuttleTaskModeType.PAK_IN.id, assignCommand, shuttleThread);
+                List<ShuttleCommand> commands = this.shuttleAssignCommand(currentLocNo, chargeLocNo, NavigationMapType.NONE.id, assignCommand, shuttleThread);
+                if (commands == null) {
+                    return;//鏈壘鍒拌矾寰�
+                }
                 //杩涜鍏呯數涓�
                 shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.CHARGING);
 
@@ -2469,22 +2455,38 @@
                     MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
                 }
             }else {
-                //涓嶅悓灞傦紝灏嗙洰鏍囧簱浣嶅垎閰嶆垚鎻愬崌鏈哄簱浣嶅彿
+                //涓嶅悓灞傦紝璋冨害灏忚溅鍒板厖鐢垫々鐩爣灞�
 
                 ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
 
-                //灏忚溅绉诲姩鍒版彁鍗囨満鍙o紝璁$畻璺緞
-                List<ShuttleCommand> commands = this.shuttleAssignCommand(currentLocNo, liftLocNo, ShuttleTaskModeType.PAK_IN.id, assignCommand, shuttleThread);
+                //鑾峰彇灏忚溅褰撳墠妤煎眰鐨勭珯鐐瑰彿
+                String liftSiteLocNo = Utils.levToOutInStaLocNo(currentLev);
+
+                //灏忚溅绉诲姩鍒版彁鍗囨満鍙g珯鐐癸紝璁$畻璺緞
+                List<ShuttleCommand> commands = this.shuttleAssignCommand(currentLocNo, liftSiteLocNo, NavigationMapType.NONE.id, assignCommand, shuttleThread);
+                if (commands == null) {
+                    return;//鏈壘鍒拌矾寰�
+                }
+
+                //鑾峰彇褰撳墠灏忚溅鎵�鍦ㄦゼ灞傜殑绔欑偣淇℃伅
+                BasDevp basDevp = basDevpService.queryByLocNo(liftSiteLocNo);
+                if (basDevp == null) {
+                    return;//鎵句笉鍒扮珯鐐逛俊鎭�
+                }
+                Short basDevpQrCode = Short.parseShort(basDevp.getQrCodeValue());//绔欑偣浜岀淮鐮�
+
+                //澧炲姞绉诲姩杩涙彁鍗囨満鍛戒护
+                ShuttleCommand moveCommand = shuttleThread.getMoveCommand(basDevpQrCode, liftProtocol.getBarcode(), 1400, ShuttleRunDirection.TOP.id, basDevpQrCode, 1400, 500);
+                commands.add(moveCommand);
+
                 //鍒嗛厤鐩爣搴撲綅
-                shuttleProtocol.setLocNo(liftLocNo);
-
-
+                shuttleProtocol.setLocNo(chargeLocNo);
                 assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());
                 assignCommand.setTaskMode((short) 9);//鍏呯數
                 assignCommand.setTaskNo(wrkCharge.getWrkNo().shortValue());
                 assignCommand.setCharge(true);//鍏呯數浠诲姟
                 //鐩爣搴撲綅
-                assignCommand.setLocNo(liftLocNo);
+                assignCommand.setLocNo(chargeLocNo);
                 //婧愬簱浣�
                 assignCommand.setSourceLocNo(currentLocNo);
                 assignCommand.setCommands(commands);
@@ -2496,23 +2498,20 @@
             }
 
         }else if(wrkCharge.getWrkSts() == 53){
-            //灏忚溅宸茬粡杈惧埌鎻愬崌鏈哄彛
-            LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, liftSlave.getId());
-            if (liftThread == null) {
-                return;
-            }
-            LiftProtocol liftProtocol = liftThread.getLiftProtocol();
-            if (liftProtocol == null) {
-                return;
-            }
+            //灏忚溅宸茬粡杈惧埌鎻愬崌鏈哄唴
 
             //鍒ゆ柇鎻愬崌鏈烘槸鍚﹀浜庣┖闂茬姸鎬�
             if (!liftProtocol.isIdle()) {
                 return;
             }
 
+            //鍒ゆ柇灏忚溅鏄惁鍦ㄦ彁鍗囨満鍐�
+            if (shuttleProtocol.getCurrentCode().intValue() != liftProtocol.getBarcode().intValue()) {
+                //灏忚溅涓嶅湪鎻愬崌鏈哄唴
+                return;
+            }
+
             //缁欐彁鍗囨満鍒嗛厤浠诲姟
-            liftProtocol.setLiftLock(true);//閿佸畾鎻愬崌鏈�
             liftProtocol.setTaskNo(wrkCharge.getWrkNo().shortValue());//璁剧疆浠诲姟鍙�
             liftProtocol.setShuttleNo(wrkCharge.getShuttleNo().shortValue());//璁剧疆鍥涘悜绌挎杞﹀彿
             liftProtocol.setProtocolStatus(LiftProtocolStatusType.WORKING);//璁剧疆鎻愬崌鏈虹姸鎬佷负宸ヤ綔涓�
@@ -2520,28 +2519,10 @@
             //鍛戒护list
             ArrayList<LiftCommand> commands = new ArrayList<>();
 
-            //鎻愬崌鏈哄綋鍓嶆ゼ灞�
-            int liftLev = liftProtocol.getLev().intValue();
-            if (liftLev != currentLev) {
-                //绌挎杞﹀拰鎻愬崌鏈哄浜庝笉鍚屾ゼ灞�
-                //鑾峰彇鐩爣妤煎眰(绌挎杞︽墍鍦ㄦゼ灞�)鍛戒护
-                LiftCommand command1 = liftThread.getLiftUpDownCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), currentLev);
-                commands.add(command1);//灏嗗懡浠ゆ坊鍔犺繘list
-            }
-
-            //杈撻�佺嚎灏嗗洓鍚戠┛姊溅绉诲姩杩涙潵(姝h浆)
-            LiftCommand command2 = liftThread.getLiftTurnCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), 1);
-            commands.add(command2);//灏嗗懡浠ゆ坊鍔犺繘list
-
             //鎻愬崌鏈哄墠寰�鐩爣妤煎眰
             //鑾峰彇鍏呯數搴撲綅鐩爣妤煎眰鍛戒护
-            LiftCommand command3 = liftThread.getLiftUpDownCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), chargeLocNoLev);
-            commands.add(command3);//灏嗗懡浠ゆ坊鍔犺繘list
-
-            //鎻愬崌鏈哄埌杈炬寚瀹氭ゼ灞傦紝杈撻�佺嚎灏嗗洓鍚戠┛姊溅绉诲嚭鍘�
-            //杈撻�佺嚎灏嗗洓鍚戠┛姊溅绉诲姩鍑哄幓(鍙嶈浆)
-            LiftCommand command4 = liftThread.getLiftTurnCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), 2);
-            commands.add(command4);//灏嗗懡浠ゆ坊鍔犺繘list
+            LiftCommand command1 = liftThread.getLiftUpDownCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), chargeLocNoLev >= 2 ? chargeLocNoLev + 1 : chargeLocNoLev);
+            commands.add(command1);//灏嗗懡浠ゆ坊鍔犺繘list
 
             wrkCharge.setWrkSts(54L);//鎻愬崌鏈烘惉杩愪腑
             //鎵�闇�鍛戒护缁勫悎瀹屾瘯锛屾洿鏂版暟鎹簱锛屾彁浜ゅ埌绾跨▼鍘诲伐浣�
@@ -2554,10 +2535,64 @@
                 MessageQueue.offer(SlaveType.Lift, liftProtocol.getLiftNo().intValue(), new Task(3, assignCommand));
             }
 
-        } else if (wrkCharge.getWrkSts() == 56) {
+        }else if(wrkCharge.getWrkSts() == 55){//55.鎻愬崌鏈鸿縼绉诲皬杞﹀畬鎴�
+            //鐩存帴璁$畻杞﹀埌鍏呯數搴撲綅
+
+            ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
+
+            Short liftLev = liftProtocol.getLev();
+            if (liftLev == null) {
+                return;
+            }
+            //鍒ゆ柇鎻愬崌鏈烘ゼ灞傛槸鍚﹀埌杈剧洰鏍囨ゼ灞�
+            if (liftLev.intValue() != chargeLocNoLev) {
+                return;//娌℃湁鍒拌揪鐩爣妤煎眰
+            }
+
+            //姝ゆ椂杞﹀湪鎻愬崌鏈哄唴閮紝涓嬭揪涓�姝ユ寚浠よ杞︾Щ鍔ㄥ埌鎻愬崌鏈哄彛
+            Integer staNo = Utils.levToOutInStaNo(liftLev >= 2 ? liftLev + 1 : liftLev);//绔欑偣鍙�
+            BasDevp basDevp = basDevpService.selectById(staNo);
+            if (basDevp == null) {
+                return;//绔欑偣涓嶅瓨鍦�
+            }
+
+            //鑾峰彇灏忚溅鍒板厖鐢靛簱浣嶈矾寰勬寚浠�
+            List<ShuttleCommand> commands = this.shuttleAssignCommand(currentLocNo, chargeLocNo, NavigationMapType.NONE.id, assignCommand, shuttleThread);
+            if (commands == null) {
+                return;//鏈壘鍒拌矾寰�
+            }
+
+            short startCode = liftProtocol.getBarcode();//鎻愬崌鏈哄唴閮ㄤ簩缁寸爜
+            Short distCode = Short.parseShort(basDevp.getQrCodeValue());//鎻愬崌鏈哄彛绔欑偣浜岀淮鐮�
+            Short runDirection = ShuttleRunDirection.BOTTOM.id;//杩愯鏂瑰悜
+            //鑾峰彇鍛戒护
+            ShuttleCommand moveCommand = shuttleThread.getMoveCommand(startCode, distCode, 1400, runDirection, startCode, 1400, 500);
+            commands.add(0, moveCommand);//灏嗚鎸囦护娣诲姞鍒伴槦澶�
+
+            //杩涜鍏呯數涓�
+            shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.CHARGING);
+
+            assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());
+            assignCommand.setTaskMode((short) 9);//鍏呯數
+            assignCommand.setTaskNo(wrkCharge.getWrkNo().shortValue());
+            assignCommand.setCharge(true);//鍏呯數浠诲姟
+
+            //鍒涘缓鍏呯數鎸囦护
+            ShuttleCommand command = shuttleThread.getChargeSwitchCommand((short) 1);//寮�濮嬪厖鐢�
+            commands.add(command);
+
+            //鎸囦护闆嗗垎閰�
+            assignCommand.setCommands(commands);
+
+            wrkCharge.setWrkSts(56L);//鍏呯數涓姸鎬�
+            if (wrkChargeMapper.updateById(wrkCharge) > 0) {
+                //涓嬪彂浠诲姟
+                MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
+            }
+        }else if (wrkCharge.getWrkSts() == 56) {
             //鍏呯數涓�
             //鍒ゆ柇灏忚溅鏄惁鍏呮弧鐢甸噺锛屾弧鐢�1000鎴栫數鍘�54V浠ヤ笂
-            if (shuttleProtocol.getBatteryPower() >= 1000 || shuttleProtocol.getCurrentVoltage() >= 540) {
+            if (shuttleProtocol.getBatteryPower() >= 1000 || shuttleProtocol.getCurrentVoltage() >= 54000) {
                 //鍏呮弧锛屾柇寮�鍏呯數
                 List<ShuttleCommand> commands = new ArrayList<>();
                 ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
diff --git a/src/main/java/com/zy/core/MainProcess.java b/src/main/java/com/zy/core/MainProcess.java
index ae94d5c..18d86f0 100644
--- a/src/main/java/com/zy/core/MainProcess.java
+++ b/src/main/java/com/zy/core/MainProcess.java
@@ -74,8 +74,8 @@
                     // 鍏朵粬  ===>> LED鏄剧ず鍣ㄥ浣嶏紝鏄剧ず榛樿淇℃伅
                     mainService.ledReset();
                     // 绌挎杞� ===>> 灏忚溅鐢甸噺妫�娴嬪厖鐢�
-//                    mainService.loopShuttleCharge();
-//                    mainService.executeShuttleCharge();
+                    mainService.loopShuttleCharge();
+                    mainService.executeShuttleCharge();
 
 //                    //鍑哄叆搴撴ā寮�
 //                    i++;
diff --git a/src/main/java/com/zy/core/enums/ShuttleChargeType.java b/src/main/java/com/zy/core/enums/ShuttleChargeType.java
index 6e71885..7a99275 100644
--- a/src/main/java/com/zy/core/enums/ShuttleChargeType.java
+++ b/src/main/java/com/zy/core/enums/ShuttleChargeType.java
@@ -5,6 +5,7 @@
 public enum ShuttleChargeType {
 
     FIRST(1, "1800102"),
+    SECOND(2, "1800103"),
     ;
 
     ShuttleChargeType(int id, String locNo) {
diff --git a/src/main/java/com/zy/core/model/protocol/LiftProtocol.java b/src/main/java/com/zy/core/model/protocol/LiftProtocol.java
index 419beee..fd78a3c 100644
--- a/src/main/java/com/zy/core/model/protocol/LiftProtocol.java
+++ b/src/main/java/com/zy/core/model/protocol/LiftProtocol.java
@@ -269,7 +269,7 @@
     }
 
     public void setPositionArrivalFeedback(Short position) {
-        Short lev = 1;
+        Short lev = null;
         switch (position) {
             case 1:
                 lev = 1;
diff --git a/src/main/java/com/zy/core/model/protocol/ShuttleProtocol.java b/src/main/java/com/zy/core/model/protocol/ShuttleProtocol.java
index d56f972..eb577c1 100644
--- a/src/main/java/com/zy/core/model/protocol/ShuttleProtocol.java
+++ b/src/main/java/com/zy/core/model/protocol/ShuttleProtocol.java
@@ -2,6 +2,7 @@
 
 import com.core.common.SpringUtils;
 import com.zy.asrs.entity.BasDevp;
+import com.zy.asrs.entity.BasShuttle;
 import com.zy.asrs.entity.BasShuttleErr;
 import com.zy.asrs.entity.LocMast;
 import com.zy.asrs.service.BasDevpService;
@@ -284,18 +285,31 @@
             return false;
         }
 
-        boolean res = this.busyStatusType.equals(ShuttleStatusType.IDLE)
-                && this.pakMk.equals(true)
-                && this.errorCodeType.equals(ShuttleErrorCodeType.NORMAL)
+        boolean res = this.busyStatusType.id.intValue() == ShuttleStatusType.IDLE.id.intValue()
+                && this.pakMk
+                && this.errorCodeType.id.intValue() == ShuttleErrorCodeType.NORMAL.id.intValue()
                 && this.taskNo == 0
+                && this.protocolStatusType.id == ShuttleProtocolStatusType.IDLE.id
                 ;
         if (!res) {
             return res;
         } else {
             // 鐢甸噺灏忎簬闃堝�兼垨鐢靛帇灏忎簬48V锛岄渶瑕佽繘琛屽厖鐢�
             try {
-                Integer chargeLine = SpringUtils.getBean(BasShuttleService.class).selectById(this.shuttleNo).getChargeLine();
-                return this.getBatteryPower$() < chargeLine || this.currentVoltage < 480;
+                BasShuttleService shuttleService = SpringUtils.getBean(BasShuttleService.class);
+                if (shuttleService == null) {
+                    return false;
+
+                }
+                BasShuttle basShuttle = shuttleService.selectById(this.shuttleNo);
+                if (basShuttle == null) {
+                    return false;
+                }
+                Integer chargeLine = basShuttle.getChargeLine();
+                if (chargeLine == null) {
+                    return false;
+                }
+                return this.getBatteryPower$() < chargeLine || this.currentVoltage < 48000;
             } catch (Exception e) {
                 News.error("fail", e);
                 return false;
diff --git a/src/main/java/com/zy/core/thread/SiemensDevpThread.java b/src/main/java/com/zy/core/thread/SiemensDevpThread.java
index f46b360..6ddc4e4 100644
--- a/src/main/java/com/zy/core/thread/SiemensDevpThread.java
+++ b/src/main/java/com/zy/core/thread/SiemensDevpThread.java
@@ -53,10 +53,6 @@
         add(107);add(108);
     }};
 
-    public boolean charge0;
-    public boolean charge1;
-    public boolean charge2;
-
     public SiemensDevpThread(DevpSlave slave) {
         this.slave = slave;
     }

--
Gitblit v1.9.1