From 5589dd50d57175ca231827be7bb2a9fb18875c7f Mon Sep 17 00:00:00 2001
From: Junjie <fallin.jie@qq.com>
Date: 星期一, 26 六月 2023 19:25:28 +0800
Subject: [PATCH] 充电任务,出入库bug

---
 src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java | 1031 +++++++++++++++++++++++++++------------------------------
 1 files changed, 491 insertions(+), 540 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..9a25422 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.*;
@@ -683,8 +684,17 @@
                                 //鐘舵��8锛岀瓑寰呭懡浠よ繘琛屽叆搴撴惉杩愬姩浣�
 
                                 //鍒ゆ柇鎻愬崌鏈烘槸鍚︾┖闂�
-                                if (!liftProtocol.isIdle()) {
+                                if (!liftProtocol.isIdleNoTask()) {
+                                    try {
+                                        Thread.sleep(1000);//浼戠湢1s
+                                    } catch (InterruptedException e) {
+                                        throw new RuntimeException(e);
+                                    }
                                     continue;//鎻愬崌鏈哄繖
+                                }
+                                //鍒ゆ柇鎻愬崌鏈轰换鍔″彿鍜屽綋鍓嶅伐浣滄。浠诲姟鍙锋槸鍚︿竴鑷�
+                                if (liftProtocol.getTaskNo().intValue() != 0 && liftProtocol.getTaskNo().intValue() != wrkMast.getWrkNo()) {
+                                    continue;
                                 }
 
                                 //鍒ゆ柇鎻愬崌鏈烘ゼ灞傛槸鍚﹀埌浣嶏紝鍒ゆ柇绔欑偣鏄惁缁欏嚭鎻愬崌鏈哄埌浣嶄俊鍙�
@@ -768,7 +778,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);
@@ -977,8 +990,17 @@
                     }else if(wrkMast.getWrkSts() == 25) {//鐘舵��25锛岄渶瑕佸悜灏忚溅涓嬪彂鍛戒护浠庢彁鍗囨満绉诲姩鍑哄幓锛岄渶瑕佸垽鏂彁鍗囨満鐘舵槸鍚︾┖闂层�佹彁鍗囨満鏄惁鍒拌揪鐩爣妤煎眰銆佺洰鏍囨ゼ灞傜珯鐐规槸鍚﹀瓨鍦ㄣ�佺洰鏍囨ゼ灞傜珯鐐规槸鍚︾粰鍑烘彁鍗囨満鍒颁綅淇″彿
 
                         //鍒ゆ柇鎻愬崌鏈烘槸鍚︾┖闂�
-                        if (!liftProtocol.isIdle()) {
+                        if (!liftProtocol.isIdleNoTask()) {
+                            try {
+                                Thread.sleep(1000);//浼戠湢1s
+                            } catch (InterruptedException e) {
+                                throw new RuntimeException(e);
+                            }
                             continue;//鎻愬崌鏈哄繖
+                        }
+                        //鍒ゆ柇鎻愬崌鏈轰换鍔″彿鍜屽綋鍓嶅伐浣滄。浠诲姟鍙锋槸鍚︿竴鑷�
+                        if (liftProtocol.getTaskNo().intValue() != 0 && liftProtocol.getTaskNo().intValue() != wrkMast.getWrkNo()) {
+                            continue;
                         }
 
                         //鍒ゆ柇鎻愬崌鏈烘ゼ灞傛槸鍚﹀埌浣嶏紝鍒ゆ柇绔欑偣鏄惁缁欏嚭鎻愬崌鏈哄埌浣嶄俊鍙�
@@ -989,7 +1011,7 @@
                             continue;//鎻愬崌鏈轰笉鍦ㄧ洰鏍囨ゼ灞傝烦杩�
                         }
 
-                        Integer staNo = Utils.levToOutInStaNo(lev);
+                        Integer staNo = Utils.levToOutInStaNo(lev >= 2 ? lev + 1 : lev);
                         DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, 1);
                         //鑾峰彇鐩爣绔欎俊鎭�
                         StaProtocol staProtocol1 = devpThread.getStation().get(staNo);
@@ -1024,32 +1046,26 @@
                         continue;
                     }
 
-                    wrkMast.setShuttleNo(shuttleProtocol.getShuttleNo().intValue());//缁欏伐浣滄。鍒嗛厤鍥涘悜绌挎杞﹀彿
-                    //婧愬簱浣�(灏忚溅褰撳墠浣嶇疆)
-                    String currentLocNo = shuttleProtocol.getCurrentLocNo();
-
-                    //灏忚溅褰撳墠灞傞珮
-                    Integer currentLev = Utils.getLev(currentLocNo);
-                    //鑾峰彇鎻愬崌鏈�
-                    LiftSlave liftSlave = slaveProperties.getLift().get(0);
-                    //褰撳墠妤煎眰鎻愬崌鏈鸿緭閫佺珯鐐瑰簱浣嶅彿
-                    String liftSiteLocNo = Utils.levToOutInStaLocNo(currentLev);
-
-                    //鍒嗛厤浠诲姟鍙�
-                    shuttleProtocol.setTaskNo(wrkMast.getWrkNo().shortValue());
-                    //鍒嗛厤婧愬簱浣�
-                    shuttleProtocol.setSourceLocNo(currentLocNo);
-
-                    ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
-                    //鍥涘悜绌挎杞﹀彿
-                    assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());
-                    //浠诲姟鍙�
-                    assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue());
-                    //鍏ュ嚭搴撴ā寮�
-                    assignCommand.setTaskMode(ShuttleTaskModeType.PAK_OUT.id.shortValue());
-                    assignCommand.setSourceLocNo(currentLocNo);
-
                     if (wrkMast.getWrkSts() == 21) {
+
+                        wrkMast.setShuttleNo(shuttleProtocol.getShuttleNo().intValue());//缁欏伐浣滄。鍒嗛厤鍥涘悜绌挎杞﹀彿
+                        //婧愬簱浣�(灏忚溅褰撳墠浣嶇疆)
+                        String currentLocNo = shuttleProtocol.getCurrentLocNo();
+
+                        //灏忚溅褰撳墠灞傞珮
+                        Integer currentLev = Utils.getLev(currentLocNo);
+                        //褰撳墠妤煎眰鎻愬崌鏈鸿緭閫佺珯鐐瑰簱浣嶅彿
+                        String liftSiteLocNo = Utils.levToOutInStaLocNo(currentLev);
+
+                        ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
+                        //鍥涘悜绌挎杞﹀彿
+                        assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());
+                        //浠诲姟鍙�
+                        assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue());
+                        //鍏ュ嚭搴撴ā寮�
+                        assignCommand.setTaskMode(ShuttleTaskModeType.PAK_OUT.id.shortValue());
+                        assignCommand.setSourceLocNo(currentLocNo);
+
                         //鍒ゆ柇灏忚溅鍜屽簱浣嶆槸鍚﹀湪鍚屼竴灞�
                         if (Boolean.parseBoolean(searchIdleShuttle.get("sameLay").toString())) {
                             //鍚屼竴灞�(灏嗗皬杞︾Щ鍔ㄥ埌璐х墿浣嶇疆)
@@ -1058,18 +1074,52 @@
                                 //鏈壘鍒拌矾寰勶紝绛夊緟涓嬩竴娆�
                                 continue;
                             }
+
+                            //鑾峰彇褰撳墠灏忚溅鎵�鍦ㄦゼ灞傜殑绔欑偣淇℃伅
+                            BasDevp basDevp = basDevpService.queryByLocNo(liftSiteLocNo);
+                            Short endStartCode = Short.parseShort(basDevp.getQrCodeValue());//绔欑偣浜岀淮鐮�
+
+                            String disLocNo = "190020" + Utils.getLev(liftSiteLocNo);//閬胯浣嶇疆
+                            LocMast locMast1 = locMastService.queryByLoc(disLocNo);
+                            if (locMast1 == null) {
+                                continue;//鎵句笉鍒板簱浣�
+                            }
+                            short disCode = Short.parseShort(locMast1.getQrCodeValue());
+                            //浠诲姟鎵ц瀹屽悗锛屽皬杞﹁繘鍏ョЩ寮�鎻愬崌鏈哄彛绔欑偣浣嶇疆锛屼互鍏嶅潬钀�
+                            ShuttleCommand moveCommand = shuttleThread.getMoveCommand(endStartCode, disCode, 1400, ShuttleRunDirection.BOTTOM.id, endStartCode, 1400, 500);
+                            commands.add(moveCommand);
+
                             //鍒嗛厤鐩爣搴撲綅
                             shuttleProtocol.setLocNo(wrkMast.getSourceLocNo());
+                            //鍒嗛厤浠诲姟鍙�
+                            shuttleProtocol.setTaskNo(wrkMast.getWrkNo().shortValue());
+                            //鍒嗛厤婧愬簱浣�
+                            shuttleProtocol.setSourceLocNo(currentLocNo);
                             //鐩爣搴撲綅
                             assignCommand.setLocNo(wrkMast.getSourceLocNo());
                             assignCommand.setCommands(commands);
                             wrkMast.setWrkSts(26L);//灏忚溅鎼繍涓�
+
+                            if (wrkMastMapper.updateById(wrkMast) > 0) {
+                                //涓嬪彂浠诲姟
+                                MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
+                            }
                         }else {
                             //涓嶅悓灞傦紝灏嗙洰鏍囧簱浣嶅垎閰嶆垚鎻愬崌鏈哄簱浣嶅彿(灏嗗皬杞︾Щ鍔ㄥ埌鎻愬崌鏈轰綅缃�)
 
                             //灏忚溅鍒版彁鍗囨満鍙f寚浠�
                             List<ShuttleCommand> commands = this.shuttleAssignCommand(currentLocNo, liftSiteLocNo, ShuttleTaskModeType.PAK_IN.id, assignCommand, shuttleThread);
+                            if (commands == null) {
+                                if (!currentLocNo.equals(liftSiteLocNo)) {//褰撳墠浣嶇疆涔熶笉鍦ㄦ彁鍗囨満鍙�
+                                    continue;//鏈壘鍒拌矾寰�
+                                }
+                                commands = new ArrayList<>();
+                            }
                             shuttleProtocol.setLocNo(liftSiteLocNo);
+                            //鍒嗛厤浠诲姟鍙�
+                            shuttleProtocol.setTaskNo(wrkMast.getWrkNo().shortValue());
+                            //鍒嗛厤婧愬簱浣�
+                            shuttleProtocol.setSourceLocNo(currentLocNo);
 
                             //鑾峰彇褰撳墠灏忚溅鎵�鍦ㄦゼ灞傜殑绔欑偣淇℃伅
                             BasDevp basDevp = basDevpService.queryByLocNo(liftSiteLocNo);
@@ -1083,29 +1133,71 @@
                             assignCommand.setLocNo(liftSiteLocNo);
                             assignCommand.setCommands(commands);
                             wrkMast.setWrkSts(22L);//灏忚溅杩佺Щ鐘舵��
+
+                            if (wrkMastMapper.updateById(wrkMast) > 0) {
+                                //涓嬪彂浠诲姟
+                                MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
+                            }
                         }
                     } else if (wrkMast.getWrkSts() == 25) {
-                        List<ShuttleCommand> commands = this.shuttleAssignCommand(currentLocNo, wrkMast.getSourceLocNo(), liftSiteLocNo, assignCommand, shuttleThread);
+
+                        wrkMast.setShuttleNo(shuttleProtocol.getShuttleNo().intValue());//缁欏伐浣滄。鍒嗛厤鍥涘悜绌挎杞﹀彿
+
+                        //褰撳墠妤煎眰鎻愬崌鏈鸿緭閫佺珯鐐瑰簱浣嶅彿
+                        String liftSiteLocNo = Utils.levToOutInStaLocNo(liftProtocol.getLev().intValue());
+
+                        ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
+                        //鍥涘悜绌挎杞﹀彿
+                        assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());
+                        //浠诲姟鍙�
+                        assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue());
+                        //鍏ュ嚭搴撴ā寮�
+                        assignCommand.setTaskMode(ShuttleTaskModeType.PAK_OUT.id.shortValue());
+                        assignCommand.setSourceLocNo(liftSiteLocNo);
+
+                        //鑾峰彇褰撳墠灏忚溅鎵�鍦ㄦゼ灞傜殑绔欑偣淇℃伅
+                        BasDevp basDevp = basDevpService.queryByLocNo(liftSiteLocNo);
+                        Short endStartCode = Short.parseShort(basDevp.getQrCodeValue());//绔欑偣浜岀淮鐮�
+
+                        String disLocNo = "190020" + Utils.getLev(liftSiteLocNo);//閬胯浣嶇疆
+                        LocMast locMast1 = locMastService.queryByLoc(disLocNo);
+                        if (locMast1 == null) {
+                            continue;//鎵句笉鍒板簱浣�
+                        }
+                        short disCode = Short.parseShort(locMast1.getQrCodeValue());
+                        //浠诲姟鎵ц瀹屽悗锛屽皬杞﹁繘鍏ョЩ寮�鎻愬崌鏈哄彛绔欑偣浣嶇疆锛屼互鍏嶅潬钀�
+                        ShuttleCommand moveCommand2 = shuttleThread.getMoveCommand(endStartCode, disCode, 1400, ShuttleRunDirection.BOTTOM.id, endStartCode, 1400, 500);
+
+                        List<ShuttleCommand> commands = this.shuttleAssignCommand(liftSiteLocNo, wrkMast.getSourceLocNo(), liftSiteLocNo, assignCommand, shuttleThread);
+                        if (commands == null) {
+                            continue;//鏈壘鍒拌矾寰�
+                        }
+                        commands.add(moveCommand2);//浠诲姟鎵ц瀹屽悗锛屽皬杞﹁繘鍏ョЩ寮�鎻愬崌鏈哄彛绔欑偣浣嶇疆锛屼互鍏嶅潬钀�
+
                         //姝ゆ椂杞﹀湪鎻愬崌鏈哄唴閮紝闇�瑕佸涓嬭揪涓�姝ユ寚浠よ杞︾Щ鍔ㄥ埌鎻愬崌鏈哄彛
-                        BasDevp basDevp = basDevpService.selectById(109);//鑾峰彇鎻愬崌鏈轰俊鎭�
-                        short startCode = Short.parseShort(basDevp.getQrCodeValue());//鎻愬崌鏈轰簩缁寸爜
+                        short startCode = liftProtocol.getBarcode();//鎻愬崌鏈哄唴閮ㄤ簩缁寸爜
                         Short distCode = commands.get(0).getStartCodeNum();//鐩爣浜岀淮鐮�
                         //鑾峰彇绉诲姩鍛戒护
-                        ShuttleCommand moveCommand = shuttleThread.getMoveCommand(startCode, distCode, 1300, commands.get(0).getRunDirection(), (short) 1, 0);
+                        ShuttleCommand moveCommand = shuttleThread.getMoveCommand(startCode, distCode, 1400, commands.get(0).getRunDirection(), startCode, 1400, 500);
                         commands.add(0, moveCommand);//灏嗚鎸囦护娣诲姞鍒伴槦澶�
 
                         //鍒嗛厤鐩爣搴撲綅
                         shuttleProtocol.setLocNo(wrkMast.getSourceLocNo());
+                        //鍒嗛厤浠诲姟鍙�
+                        shuttleProtocol.setTaskNo(wrkMast.getWrkNo().shortValue());
+                        //鍒嗛厤婧愬簱浣�
+                        shuttleProtocol.setSourceLocNo(liftSiteLocNo);
                         //鐩爣搴撲綅
                         assignCommand.setLocNo(wrkMast.getSourceLocNo());
                         assignCommand.setCommands(commands);
                         wrkMast.setWrkSts(26L);//灏忚溅鎼繍涓�
+
+                        if (wrkMastMapper.updateById(wrkMast) > 0) {
+                            //涓嬪彂浠诲姟
+                            MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
+                        }
                     }
 
-                    if (wrkMastMapper.updateById(wrkMast) > 0) {
-                        //涓嬪彂浠诲姟
-                        MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
-                    }
                 }
             }
         }
@@ -1128,7 +1220,7 @@
             //鑾峰彇鍥涘悜绌挎杞︾嚎绋�
             ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttle.getId());
             ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
-            if (shuttleProtocol == null) {
+            if (shuttleProtocol == null || shuttleProtocol.getShuttleNo() == null) {
                 continue;
             }
             if (!shuttleProtocol.isIdle()) {
@@ -1136,6 +1228,9 @@
             }
 
             String shuttleLocNo = shuttleProtocol.getCurrentLocNo();//浜岀淮鐮佸搴斿簱浣嶅彿
+            if (shuttleLocNo == null) {
+                continue;
+            }
             int shuttleLocNoLey = Utils.getLev(shuttleLocNo);//搴撲綅鍙峰搴斿眰楂�
             if (lev == shuttleLocNoLey) {
                 //宸ヤ綔妗fゼ灞傜浉鍚岀殑绌挎杞�
@@ -1144,49 +1239,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) {
@@ -1283,6 +1336,9 @@
                     && shuttleProtocol.getTaskNo() != 0
                     && shuttleProtocol.getBusyStatus() == 0
             ) {
+                //鏍囪澶嶄綅
+                shuttleProtocol.setPakMk(true);
+
                 //灏嗕换鍔℃。鏍囪涓哄畬鎴�
                 WrkMast wrkMast = wrkMastMapper.selectByWorkNo(shuttleProtocol.getTaskNo().intValue());
                 if (wrkMast != null) {
@@ -1311,8 +1367,6 @@
                         shuttleProtocol.setSourceLocNo(null);
                         //鐩爣搴撲綅娓呴浂
                         shuttleProtocol.setLocNo(null);
-                        //鏍囪澶嶄綅
-                        shuttleProtocol.setPakMk(true);
                         //浠诲姟鎸囦护娓呴浂
                         shuttleProtocol.setAssignCommand(null);
                         News.info("鍥涘悜绌挎杞﹀凡纭涓斾换鍔″畬鎴愮姸鎬�,澶嶄綅銆傚洓鍚戠┛姊溅鍙�={}", shuttleProtocol.getShuttleNo());
@@ -1334,10 +1388,8 @@
                             wrkCharge.setWrkSts(53L);//杩佺Щ瀹屾垚
                             shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.CHARGING);
                             break;
-                        case 56:
-                            if (shuttleProtocol.getBatteryPower() == 1000) {
-                                wrkCharge.setWrkSts(60L);//鍏呯數瀹屾垚
-                            }
+                        case 56://灏忚溅鍘诲厖鐢垫々涓�
+                            wrkCharge.setWrkSts(57L);//鍒拌揪鍏呯數妗�
                             break;
                         default:
                     }
@@ -1347,16 +1399,18 @@
                             //璁剧疆鍥涘悜绌挎杞︿负绌洪棽鐘舵��
                             shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.IDLE);
                         }
-                        //浠诲姟鍙锋竻闆�
-                        shuttleProtocol.setTaskNo((short) 0);
-                        //婧愬簱浣嶆竻闆�
-                        shuttleProtocol.setSourceLocNo(null);
-                        //鐩爣搴撲綅娓呴浂
-                        shuttleProtocol.setLocNo(null);
-                        //鏍囪澶嶄綅
-                        shuttleProtocol.setPakMk(true);
-                        //浠诲姟鎸囦护娓呴浂
-                        shuttleProtocol.setAssignCommand(null);
+                        if (wrkCharge.getWrkSts() != 57) {
+                            //浠诲姟鍙锋竻闆�
+                            shuttleProtocol.setTaskNo((short) 0);
+                            //婧愬簱浣嶆竻闆�
+                            shuttleProtocol.setSourceLocNo(null);
+                            //鐩爣搴撲綅娓呴浂
+                            shuttleProtocol.setLocNo(null);
+                            //鏍囪澶嶄綅
+                            shuttleProtocol.setPakMk(true);
+                            //浠诲姟鎸囦护娓呴浂
+                            shuttleProtocol.setAssignCommand(null);
+                        }
                         News.info("鍥涘悜绌挎杞﹀凡纭涓斾换鍔″畬鎴愮姸鎬�,澶嶄綅銆傚洓鍚戠┛姊溅鍙�={}", shuttleProtocol.getShuttleNo());
                     } else {
                         News.error("鍥涘悜绌挎杞﹀凡纭涓斾换鍔″畬鎴愮姸鎬�,澶嶄綅澶辫触锛屼絾鏈壘鍒板伐浣滄。銆傚洓鍚戠┛姊溅鍙�={}锛屽伐浣滃彿={}", shuttleProtocol.getShuttleNo(), shuttleProtocol.getTaskNo());
@@ -1381,8 +1435,13 @@
                 continue;
             }
 
-            //鍒ゆ柇鎻愬崌鏈烘槸鍚﹀浜庣┖闂茬姸鎬�
-            if (!liftProtocol.isIdle()) {
+
+//            if (!liftProtocol.isIdle()) {
+//                continue;
+//            }
+
+            //鍒ゆ柇鎻愬崌鏈烘槸鍚﹀浜庣┖闂茬姸鎬侊紝娌℃湁鍒ゆ柇浠诲姟鍙凤紝鍙兘鎻愬崌鏈哄浜庣┖闂诧紝浣嗘槸杩樻湁浠诲姟鏈畬鎴�
+            if (!liftProtocol.isIdleNoTask()) {
                 continue;
             }
 
@@ -1391,11 +1450,6 @@
             if (wrkMast == null) {
                 continue;
             }
-
-            //缁欐彁鍗囨満鍒嗛厤浠诲姟
-            liftProtocol.setLiftLock(true);//閿佸畾鎻愬崌鏈�
-            liftProtocol.setTaskNo(wrkMast.getWrkNo().shortValue());//璁剧疆浠诲姟鍙�
-            liftProtocol.setProtocolStatus(LiftProtocolStatusType.WORKING);//璁剧疆鎻愬崌鏈虹姸鎬佷负宸ヤ綔涓�
 
             //鍛戒护list
             ArrayList<LiftCommand> commands = new ArrayList<>();
@@ -1409,19 +1463,27 @@
             }
 
             if (wrkMast.getWrkSts() == 2) {//2.璁惧涓婅蛋
+                if (liftProtocol.getTaskNo().intValue() != 0) {
+                    //瀛樺湪鏈畬鎴愪换鍔″彿
+                    continue;
+                }
+                if (liftProtocol.getPlatShuttleCheck()) {
+                    //鎻愬崌鏈烘鏃舵湁鍥涘悜杞︼紝鍙兘鏈夋湭瀹屾垚鐨勪换鍔★紝绂佹鍒嗛厤鏂颁换鍔�
+                    continue;
+                }
+
                 //宸ヤ綔妗g洰鏍囧簱浣嶅彿
                 String wrkMastLocNo = wrkMast.getLocNo();
                 //宸ヤ綔妗g洰鏍囧簱浣嶆ゼ灞�
                 int wrkMastLocNoLey = Utils.getLev(wrkMastLocNo);
 
-                //鎻愬崌鏈哄綋鍓嶆ゼ灞�
-                int liftLev = liftProtocol.getLev().intValue();
-                if (liftLev == 0) {//鎻愬崌鏈哄綋鍓嶆ゼ灞備负0锛屾彁鍗囨満澶卞幓浣嶇疆淇℃伅锛岃鎻愬崌鏈哄墠寰�涓�妤�
-                    LiftCommand command = liftThread.getLiftUpDownCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), LiftLevType.ONE.lev);
-                    commands.add(command);//灏嗗懡浠ゆ坊鍔犺繘list
+                Integer levTmp = wrkMastLocNoLey;
+                if (wrkMastLocNoLey >= 2) {
+                    levTmp += 1;
                 }
+                Integer distStaNo = Utils.levToOutInStaNo(levTmp);
 
-                if (liftLev != LiftLevType.TWO.realLev) {
+                if (liftProtocol.getPositionArrivalFeedback().intValue() != LiftLevType.TWO.realLev.intValue()) {
                     //鎻愬崌鏈轰笉鍦ㄨ緭閫佺嚎妤煎眰锛岃幏鍙栧埌杈撻�佺嚎灞傜殑鎻愬崌鏈哄懡浠�
                     LiftCommand command1 = liftThread.getLiftUpDownCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), LiftLevType.TWO.lev);
                     commands.add(command1);//灏嗗懡浠ゆ坊鍔犺繘list
@@ -1432,12 +1494,8 @@
                 command2.setOperaStaNo((short) 102);//鎿嶄綔102绔�
                 command2.setRotationDire(1);//缁欒緭閫佺嚎涓嬪彂閾炬潯杞姩淇″彿锛屾杞�
                 command2.setDevpId(devpId);
+                command2.setStaNo(distStaNo.shortValue());//璁剧疆鐩爣绔�
                 commands.add(command2);//灏嗗懡浠ゆ坊鍔犺繘list
-
-                Integer levTmp = wrkMastLocNoLey;
-                if (wrkMastLocNoLey >= 2) {
-                    levTmp += 1;
-                }
 
                 //鎻愬崌鏈哄墠寰�鐩爣妤煎眰(宸ヤ綔妗g洰鏍囨ゼ灞�)
                 LiftCommand command3 = liftThread.getLiftUpDownCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), levTmp);
@@ -1446,15 +1504,22 @@
                 //鎻愬崌鏈哄埌杈炬寚瀹氭ゼ灞傦紝杈撻�佺嚎灏嗚揣鐗╃Щ鍑哄幓(姝h浆)
                 //杈撻�佺嚎灏嗚揣鐗╃Щ鍑哄幓
                 LiftCommand command4 = liftThread.getLiftTurnCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), 1);
-                Integer distStaNo = Utils.levToOutInStaNo(levTmp);
                 command4.setOperaStaNo(distStaNo.shortValue());//鎿嶄綔鐩爣妤煎眰绔欑偣
                 command4.setRotationDire(1);//缁欒緭閫佺嚎涓嬪彂閾炬潯杞姩淇″彿锛屾杞�
                 command4.setDevpId(devpId);
                 command4.setStaNo(distStaNo.shortValue());//璁剧疆鐩爣绔�
                 commands.add(command4);//灏嗗懡浠ゆ坊鍔犺繘list
 
+                //缁欐彁鍗囨満鍒嗛厤浠诲姟
+                liftProtocol.setTaskNo(wrkMast.getWrkNo().shortValue());//璁剧疆浠诲姟鍙�
+                liftProtocol.setProtocolStatus(LiftProtocolStatusType.WORKING);//璁剧疆鎻愬崌鏈虹姸鎬佷负宸ヤ綔涓�
+
                 wrkMast.setWrkSts(3L);//3.鎻愬崌鏈烘惉杩愪腑
             } else if (wrkMast.getWrkSts() == 6) {//6.杩佺Щ灏忚溅鑷虫彁鍗囨満鍙e畬鎴� => 7.鎻愬崌鏈鸿縼绉诲皬杞︿腑
+                if (liftProtocol.getTaskNo().intValue() != 0 && liftProtocol.getTaskNo().intValue() != wrkMast.getWrkNo()) {
+                    //鎻愬崌鏈哄瓨鍦ㄦ湭瀹屾垚浠诲姟锛屼笖鎻愬崌鏈轰换鍔″彿鍜屽綋鍓嶅伐浣滄。浠诲姟鍙蜂笉涓�鑷�
+                    continue;
+                }
                 liftProtocol.setShuttleNo(wrkMast.getShuttleNo().shortValue());//璁剧疆鍥涘悜绌挎杞﹀彿
 
                 //鍒ゆ柇灏忚溅鏄惁鍦ㄦ彁鍗囨満鍐咃紝涓斿浜庣┖闂茬姸鎬�
@@ -1472,9 +1537,13 @@
                 if (shuttleProtocol.getCurrentCode().intValue() != liftProtocol.getBarcode().intValue()) {
                     continue;//灏忚溅褰撳墠浜岀淮鐮佸拰鎻愬崌鏈哄唴閮ㄤ簩缁寸爜涓嶄竴鑷达紝涓嶅厑璁告墽琛�
                 }
+                if (!liftProtocol.getPlatShuttleCheck()) {
+                    //鎻愬崌鏈烘湭妫�娴嬪埌灏忚溅锛岀姝㈡墽琛�
+                    continue;
+                }
 
                 //宸ヤ綔妗g洰鏍囧簱浣嶅彿
-                String wrkMastLocNo = wrkMast.getIoType() == 101 ? wrkMast.getSourceLocNo() : wrkMast.getLocNo();
+                String wrkMastLocNo = wrkMast.getLocNo();
                 //宸ヤ綔妗g洰鏍囧簱浣嶆ゼ灞�
                 int wrkMastLocNoLey = Utils.getLev(wrkMastLocNo);
                 if (wrkMastLocNoLey >= 2) {
@@ -1484,9 +1553,17 @@
                 //鎻愬崌鏈哄墠寰�鐩爣妤煎眰(宸ヤ綔妗g洰鏍囨ゼ灞�)
                 LiftCommand command1 = liftThread.getLiftUpDownCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), wrkMastLocNoLey);
                 commands.add(command1);//灏嗗懡浠ゆ坊鍔犺繘list
+
+                //缁欐彁鍗囨満鍒嗛厤浠诲姟
+                liftProtocol.setTaskNo(wrkMast.getWrkNo().shortValue());//璁剧疆浠诲姟鍙�
+                liftProtocol.setProtocolStatus(LiftProtocolStatusType.WORKING);//璁剧疆鎻愬崌鏈虹姸鎬佷负宸ヤ綔涓�
 
                 wrkMast.setWrkSts(7L);//6.杩佺Щ灏忚溅鑷虫彁鍗囨満鍙e畬鎴� => 7.鎻愬崌鏈鸿縼绉诲皬杞︿腑
             } else if(wrkMast.getWrkSts() == 23) {//23.杩佺Щ灏忚溅鑷虫彁鍗囨満鍙e畬鎴� => 24.鎻愬崌鏈鸿縼绉诲皬杞︿腑
+                if (liftProtocol.getTaskNo().intValue() != 0 && liftProtocol.getTaskNo().intValue() != wrkMast.getWrkNo()) {
+                    //鎻愬崌鏈哄瓨鍦ㄦ湭瀹屾垚浠诲姟锛屼笖鎻愬崌鏈轰换鍔″彿鍜屽綋鍓嶅伐浣滄。浠诲姟鍙蜂笉涓�鑷�
+                    continue;
+                }
                 liftProtocol.setShuttleNo(wrkMast.getShuttleNo().shortValue());//璁剧疆鍥涘悜绌挎杞﹀彿
 
                 //鍒ゆ柇灏忚溅鏄惁鍦ㄦ彁鍗囨満鍐咃紝涓斿浜庣┖闂茬姸鎬�
@@ -1505,9 +1582,13 @@
                 if (shuttleProtocol.getCurrentCode().intValue() != liftProtocol.getBarcode().intValue()) {
                     continue;//灏忚溅褰撳墠浜岀淮鐮佸拰鎻愬崌鏈哄唴閮ㄤ簩缁寸爜涓嶄竴鑷达紝涓嶅厑璁告墽琛�
                 }
+                if (!liftProtocol.getPlatShuttleCheck()) {
+                    //鎻愬崌鏈烘湭妫�娴嬪埌灏忚溅锛岀姝㈡墽琛�
+                    continue;
+                }
 
                 //宸ヤ綔妗g洰鏍囧簱浣嶅彿
-                String wrkMastLocNo = wrkMast.getIoType() == 101 ? wrkMast.getSourceLocNo() : wrkMast.getLocNo();
+                String wrkMastLocNo = wrkMast.getSourceLocNo();
                 //宸ヤ綔妗g洰鏍囧簱浣嶆ゼ灞�
                 int wrkMastLocNoLey = Utils.getLev(wrkMastLocNo);
                 if (wrkMastLocNoLey >= 2) {
@@ -1518,8 +1599,21 @@
                 LiftCommand command1 = liftThread.getLiftUpDownCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), wrkMastLocNoLey);
                 commands.add(command1);//灏嗗懡浠ゆ坊鍔犺繘list
 
+                //缁欐彁鍗囨満鍒嗛厤浠诲姟
+                liftProtocol.setTaskNo(wrkMast.getWrkNo().shortValue());//璁剧疆浠诲姟鍙�
+                liftProtocol.setProtocolStatus(LiftProtocolStatusType.WORKING);//璁剧疆鎻愬崌鏈虹姸鎬佷负宸ヤ綔涓�
+
                 wrkMast.setWrkSts(24L);//23.杩佺Щ灏忚溅鑷虫彁鍗囨満鍙e畬鎴� => 24.鎻愬崌鏈鸿縼绉诲皬杞︿腑
             } else if (wrkMast.getWrkSts() == 27) {//27.灏忚溅鍑哄簱鎼繍瀹屾垚
+                if (liftProtocol.getTaskNo().intValue() != 0 && liftProtocol.getTaskNo().intValue() != wrkMast.getWrkNo()) {
+                    //鎻愬崌鏈哄瓨鍦ㄦ湭瀹屾垚浠诲姟锛屼笖鎻愬崌鏈轰换鍔″彿鍜屽綋鍓嶅伐浣滄。浠诲姟鍙蜂笉涓�鑷�
+                    continue;
+                }
+                if (liftProtocol.getPlatShuttleCheck()) {
+                    //鎻愬崌鏈烘鏃舵湁鍥涘悜杞︼紝鍙兘鏈夋湭瀹屾垚鐨勪换鍔★紝绂佹鍒嗛厤鏂颁换鍔�
+                    continue;
+                }
+
                 //宸ヤ綔妗f簮搴撲綅鍙�
                 String wrkMastLocNo = wrkMast.getSourceLocNo();
                 //宸ヤ綔妗f簮搴撲綅妤煎眰
@@ -1527,14 +1621,10 @@
 
                 //鎻愬崌鏈哄綋鍓嶆ゼ灞�
                 int liftLev = liftProtocol.getLev().intValue();
-                if (liftLev == 0) {//鎻愬崌鏈哄綋鍓嶆ゼ灞備负0锛屾彁鍗囨満澶卞幓浣嶇疆淇℃伅锛岃鎻愬崌鏈哄墠寰�涓�妤�
-                    LiftCommand command = liftThread.getLiftUpDownCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), LiftLevType.ONE.lev);
-                    commands.add(command);//灏嗗懡浠ゆ坊鍔犺繘list
-                }
 
                 //鍒ゆ柇鎻愬崌鏈烘槸鍚﹀埌浣�
-                StaProtocol staProtocol = devpThread.getStation().get(Utils.levToOutInStaNo(wrkMastLocNoLey));//璧峰绔欑偣
-                if (liftLev != wrkMastLocNoLey && wrkMastLocNoLey != 1 || !staProtocol.isLiftArrival()) {
+                StaProtocol staProtocol = devpThread.getStation().get(Utils.levToOutInStaNo(wrkMastLocNoLey >= 2 ? wrkMastLocNoLey + 1 : wrkMastLocNoLey));//璧峰绔欑偣
+                if (liftLev != wrkMastLocNoLey && !staProtocol.isLiftArrival()) {
                     //鎻愬崌鏈轰笉鍦ㄥ伐浣滄。婧愬簱浣嶆ゼ灞傦紝璋冨害鎻愬崌鏈�
                     LiftCommand command1 = liftThread.getLiftUpDownCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), wrkMastLocNoLey);
                     commands.add(command1);//灏嗗懡浠ゆ坊鍔犺繘list
@@ -1567,6 +1657,10 @@
                 command5.setStaNo((short) 104);//鍐欏叆鍑哄簱鐩爣绔�104
                 command5.setRotationDire(0);//閾炬潯杞姩鍋滄
                 commands.add(command5);
+
+                //缁欐彁鍗囨満鍒嗛厤浠诲姟
+                liftProtocol.setTaskNo(wrkMast.getWrkNo().shortValue());//璁剧疆浠诲姟鍙�
+                liftProtocol.setProtocolStatus(LiftProtocolStatusType.WORKING);//璁剧疆鎻愬崌鏈虹姸鎬佷负宸ヤ綔涓�
 
                 wrkMast.setWrkSts(28L);//28.鎻愬崌鏈烘惉杩愪腑
             }
@@ -1601,6 +1695,9 @@
                     && !liftProtocol.getRunning()
             ) {
 
+                //鏍囪澶嶄綅
+                liftProtocol.setPakMk(true);
+
                 DevpThread devpThread = null;
                 Integer devpId = null;
                 for (DevpSlave devp : slaveProperties.getDevp()){
@@ -1633,11 +1730,34 @@
                         case 28://28.鎻愬崌鏈烘惉杩愪腑 ==> 29.鎻愬崌鏈烘惉杩愬畬鎴�
                             wrkMast.setWrkSts(29L);
                             wrkMast.setWrkSts(34L);//34.鍑哄簱瀹屾垚锛屾殏鏃跺厛鐩存帴瀹屾垚鍑哄簱宸ヤ綔妗o紝鍚庣画闇�瑕佹牴鎹緭閫佺嚎缁欏嚭鐨勭姸鎬佹潵纭畾34.鍑哄簱瀹屾垚鐘舵��
+                            //浠诲姟鍙锋竻闆�
+                            liftProtocol.setTaskNo((short) 0);
                             break;
                         default:
                     }
 
                     if (wrkMastMapper.updateById(wrkMast) > 0) {
+                        //璁剧疆鎻愬崌鏈轰负绌洪棽鐘舵��
+                        liftProtocol.setProtocolStatus(LiftProtocolStatusType.IDLE);
+                        //浠诲姟鎸囦护娓呴浂
+                        liftProtocol.setAssignCommand(null);
+                        News.info("鎻愬崌鏈哄凡纭涓斾换鍔″畬鎴愮姸鎬併�傛彁鍗囨満鍙�={}", liftProtocol.getLiftNo());
+                    } else {
+                        News.error("鎻愬崌鏈哄凡纭涓斾换鍔″畬鎴愮姸鎬�,澶嶄綅澶辫触锛屼絾鏈壘鍒板伐浣滄。銆傛彁鍗囨満鍙�={}锛屽伐浣滃彿={}", liftProtocol.getLiftNo(), liftProtocol.getTaskNo());
+                    }
+                }
+
+                //鏌ヨ鏄惁鏈夊厖鐢典换鍔�
+                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);
                         //浠诲姟鍙锋竻闆�
@@ -1663,11 +1783,6 @@
                     //浠诲姟鎸囦护娓呴浂
                     liftProtocol.setAssignCommand(null);
                     News.info("鎻愬崌鏈哄凡纭涓斾换鍔″畬鎴愮姸鎬�,澶嶄綅銆傛彁鍗囨満鍙�={}", liftProtocol.getLiftNo());
-//                    LiftAssignCommand assignCommand = liftProtocol.getAssignCommand();
-//                    if (!assignCommand.getAuto()) {
-//                        //鎵嬪姩鍛戒护
-//
-//                    }
                 }
 
             }
@@ -2343,111 +2458,244 @@
      * 鍥涘悜绌挎杞︾數閲忔娴� ===>> 鍙戣捣鍏呯數
      */
     public synchronized void loopShuttleCharge() {
-        for (DevpSlave devpSlave : slaveProperties.getDevp()) {
-            SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, devpSlave.getId());
-            for (ShuttleSlave shuttle : slaveProperties.getShuttle()) {
-                //鑾峰彇鍥涘悜绌挎杞︾嚎绋�
-                ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttle.getId());
-                ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
-                if (shuttleProtocol == null) {
-                    continue;
-                }
-
-                //鍒ゆ柇褰撳墠灏忚溅鏄惁婊¤冻闇�瑕佸厖鐢佃姹�
-                if (!shuttleProtocol.isRequireCharge()) {
-                    continue;
-                }
-
-                WrkCharge wrkCharge = wrkChargeService.selectWorking(null, WrkChargeType.charge);
-                if (wrkCharge != null) {//宸叉湁鍏呯數浠诲姟
-                    continue;
-                }
-
-                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 (shuttleCharge == null) {
-                    continue;
-                }
-
-                String chargeLocNo = shuttleCharge.locNo;
-                wrkCharge = new WrkCharge();
-                wrkCharge.setShuttleNo(shuttle.getId());
-                wrkCharge.setCharge(shuttleCharge.id);
-                wrkCharge.setWrkNo(commonService.getChargeWorkNo(4));
-                wrkCharge.setWrkSts(51L);   // 21.鍑嗗鍏呯數
-                wrkCharge.setIoPri((double) 10);
-                wrkCharge.setLocNo(chargeLocNo);
-                wrkCharge.setMemo("charge");
-                wrkCharge.setAppeTime(new Date());
-                if (!wrkChargeService.insert(wrkCharge)) {
-                    News.error("淇濆瓨{}鍙峰洓鍚戠┛姊溅鍏呯數浠诲姟澶辫触!!!", shuttle.getId());
-                    continue;
-                }
-
-                shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.CHARGING);//鍏呯數涓�
-                News.info("淇濆瓨{}鍙峰洓鍚戠┛姊溅鍏呯數浠诲姟鎴愬姛!!!", shuttle.getId());
+        for (ShuttleSlave shuttle : slaveProperties.getShuttle()) {
+            //鑾峰彇鍥涘悜绌挎杞︾嚎绋�
+            ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttle.getId());
+            ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
+            if (shuttleProtocol == null) {
+                continue;
             }
+
+            //鍒ゆ柇褰撳墠灏忚溅鏄惁婊¤冻闇�瑕佸厖鐢佃姹�
+            if (!shuttleProtocol.isRequireCharge()) {
+                continue;
+            }
+
+            WrkCharge wrkCharge = wrkChargeService.selectWorking(shuttleProtocol.getShuttleNo().intValue());
+            if (wrkCharge != null) {//宸叉湁鍏呯數浠诲姟
+                continue;
+            }
+
+            ShuttleChargeType shuttleCharge = null;
+            for (ShuttleChargeType chargeType : ShuttleChargeType.values()) {
+                if (wrkChargeService.selectWorkingOfCharge(chargeType.id) == null) {
+                    shuttleCharge = chargeType;
+                    break;
+                }
+            }
+
+            if (shuttleCharge == null) {
+                continue;
+            }
+
+            String chargeLocNo = shuttleCharge.locNo;
+            wrkCharge = new WrkCharge();
+            wrkCharge.setShuttleNo(shuttle.getId());
+            wrkCharge.setCharge(shuttleCharge.id);
+            wrkCharge.setWrkNo(commonService.getChargeWorkNo(4));
+            wrkCharge.setWrkSts(51L);   // 21.鍑嗗鍏呯數
+            wrkCharge.setIoPri((double) 10);
+            wrkCharge.setLocNo(chargeLocNo);
+            wrkCharge.setMemo("charge");
+            wrkCharge.setAppeTime(new Date());
+            if (!wrkChargeService.insert(wrkCharge)) {
+                News.error("淇濆瓨{}鍙峰洓鍚戠┛姊溅鍏呯數浠诲姟澶辫触!!!", shuttle.getId());
+                continue;
+            }
+
+            shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.CHARGING);//鍏呯數涓�
+            News.info("淇濆瓨{}鍙峰洓鍚戠┛姊溅鍏呯數浠诲姟鎴愬姛!!!", shuttle.getId());
         }
-
-
     }
 
     /**
      * 鎵ц鍥涘悜绌挎杞﹀厖鐢典换鍔�
      */
     public synchronized void executeShuttleCharge() {
-        WrkCharge wrkCharge = wrkChargeService.selectWorking(null, WrkChargeType.charge);
-        if (wrkCharge == null) {
-            return;
-        }
+        for (ShuttleSlave shuttle : slaveProperties.getShuttle()) {
+            WrkCharge wrkCharge = wrkChargeService.selectWorking(shuttle.getId());
+            if (wrkCharge == null) {
+                continue;
+            }
 
+            ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkCharge.getShuttleNo());
+            if (shuttleThread == null) {
+                continue;
+            }
+            ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
+            if (shuttleProtocol == null) {
+                continue;
+            }
 
-        ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkCharge.getShuttleNo());
-        if (shuttleThread == null) {
-            return;
-        }
-        ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
-        if (shuttleProtocol == null) {
-            return;
-        }
+            //鑾峰彇鎻愬崌鏈�
+            LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, 1);
+            if (liftThread == null) {
+                continue;
+            }
+            LiftProtocol liftProtocol = liftThread.getLiftProtocol();
+            if (liftProtocol == null) {
+                continue;
+            }
+            //鍏呯數搴撲綅鍙�
+            String chargeLocNo = wrkCharge.getLocNo();
+            //鍏呯數搴撲綅灞傞珮
+            Integer chargeLocNoLev = Utils.getLev(chargeLocNo);
 
-        //褰撳墠绌挎杞﹀簱浣嶅彿
-        String currentLocNo = shuttleProtocol.getCurrentLocNo();
-        //灏忚溅褰撳墠灞傞珮
-        Integer currentLev = currentLocNo == null ? 0 : Integer.parseInt(currentLocNo.substring(currentLocNo.length() - 2, currentLocNo.length()));
-        //鑾峰彇鎻愬崌鏈�
-        LiftSlave liftSlave = slaveProperties.getLift().get(0);
-        //鎻愬崌鏈哄簱浣嶅彿
-        String liftLocNo = liftSlave.getLiftLocNo(currentLev);
-        //鍏呯數搴撲綅鍙�
-        String chargeLocNo = wrkCharge.getLocNo();
-        //鍏呯數搴撲綅灞傞珮
-        Integer chargeLocNoLev = Integer.parseInt(chargeLocNo.substring(chargeLocNo.length() - 2, chargeLocNo.length()));
+            if (wrkCharge.getWrkSts() == 51) {
+                //褰撳墠绌挎杞﹀簱浣嶅彿
+                String currentLocNo = shuttleProtocol.getCurrentLocNo();
+                if (currentLocNo == null) {
+                    continue;
+                }
+                //灏忚溅褰撳墠灞傞珮
+                Integer currentLev = Utils.getLev(currentLocNo);
 
-        if (wrkCharge.getWrkSts() == 51 || wrkCharge.getWrkSts() == 55) {
-            if (currentLev == chargeLocNoLev) {
-                //鍚屼竴灞傛棤闇�缁忚繃鎻愬崌鏈�
+                if (currentLev == chargeLocNoLev) {
+                    //鍚屼竴灞傛棤闇�缁忚繃鎻愬崌鏈�
+                    //鐩存帴璁$畻杞﹀埌鍏呯數搴撲綅
+
+                    ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
+
+                    //鑾峰彇灏忚溅鍒板厖鐢靛簱浣嶈矾寰勬寚浠�
+                    List<ShuttleCommand> commands = this.shuttleAssignCommand(currentLocNo, chargeLocNo, NavigationMapType.NONE.id, assignCommand, shuttleThread);
+                    if (commands == null) {
+                        continue;//鏈壘鍒拌矾寰�
+                    }
+                    //杩涜鍏呯數涓�
+                    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 {
+                    //涓嶅悓灞傦紝璋冨害灏忚溅鍒板厖鐢垫々鐩爣灞�
+
+                    ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
+
+                    //鑾峰彇灏忚溅褰撳墠妤煎眰鐨勭珯鐐瑰彿
+                    String liftSiteLocNo = Utils.levToOutInStaLocNo(currentLev);
+
+                    //灏忚溅绉诲姩鍒版彁鍗囨満鍙g珯鐐癸紝璁$畻璺緞
+                    List<ShuttleCommand> commands = this.shuttleAssignCommand(currentLocNo, liftSiteLocNo, NavigationMapType.NONE.id, assignCommand, shuttleThread);
+                    if (commands == null) {
+                        continue;//鏈壘鍒拌矾寰�
+                    }
+
+                    //鑾峰彇褰撳墠灏忚溅鎵�鍦ㄦゼ灞傜殑绔欑偣淇℃伅
+                    BasDevp basDevp = basDevpService.queryByLocNo(liftSiteLocNo);
+                    if (basDevp == null) {
+                        continue;//鎵句笉鍒扮珯鐐逛俊鎭�
+                    }
+                    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(chargeLocNo);
+                    assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());
+                    assignCommand.setTaskMode((short) 9);//鍏呯數
+                    assignCommand.setTaskNo(wrkCharge.getWrkNo().shortValue());
+                    assignCommand.setCharge(true);//鍏呯數浠诲姟
+                    //鐩爣搴撲綅
+                    assignCommand.setLocNo(chargeLocNo);
+                    //婧愬簱浣�
+                    assignCommand.setSourceLocNo(currentLocNo);
+                    assignCommand.setCommands(commands);
+                    wrkCharge.setWrkSts(52L);//灏忚溅杩佺Щ鐘舵��
+                    if (wrkChargeMapper.updateById(wrkCharge) > 0) {
+                        //涓嬪彂浠诲姟
+                        MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
+                    }
+                }
+
+            }else if(wrkCharge.getWrkSts() == 53){
+                //灏忚溅宸茬粡杈惧埌鎻愬崌鏈哄唴
+
+                //鍒ゆ柇鎻愬崌鏈烘槸鍚﹀浜庣┖闂茬姸鎬�
+                if (!liftProtocol.isIdle()) {
+                    continue;
+                }
+
+                //鍒ゆ柇灏忚溅鏄惁鍦ㄦ彁鍗囨満鍐�
+                if (shuttleProtocol.getCurrentCode().intValue() != liftProtocol.getBarcode().intValue()) {
+                    //灏忚溅涓嶅湪鎻愬崌鏈哄唴
+                    continue;
+                }
+
+                //缁欐彁鍗囨満鍒嗛厤浠诲姟
+                liftProtocol.setTaskNo(wrkCharge.getWrkNo().shortValue());//璁剧疆浠诲姟鍙�
+                liftProtocol.setShuttleNo(wrkCharge.getShuttleNo().shortValue());//璁剧疆鍥涘悜绌挎杞﹀彿
+                liftProtocol.setProtocolStatus(LiftProtocolStatusType.WORKING);//璁剧疆鎻愬崌鏈虹姸鎬佷负宸ヤ綔涓�
+
+                //鍛戒护list
+                ArrayList<LiftCommand> commands = new ArrayList<>();
+
+                //鎻愬崌鏈哄墠寰�鐩爣妤煎眰
+                //鑾峰彇鍏呯數搴撲綅鐩爣妤煎眰鍛戒护
+                LiftCommand command1 = liftThread.getLiftUpDownCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), chargeLocNoLev >= 2 ? chargeLocNoLev + 1 : chargeLocNoLev);
+                commands.add(command1);//灏嗗懡浠ゆ坊鍔犺繘list
+
+                wrkCharge.setWrkSts(54L);//鎻愬崌鏈烘惉杩愪腑
+                //鎵�闇�鍛戒护缁勫悎瀹屾瘯锛屾洿鏂版暟鎹簱锛屾彁浜ゅ埌绾跨▼鍘诲伐浣�
+                LiftAssignCommand assignCommand = new LiftAssignCommand();
+                assignCommand.setCommands(commands);
+                assignCommand.setLiftNo(liftProtocol.getLiftNo());
+                assignCommand.setTaskNo(liftProtocol.getTaskNo());
+                if (wrkChargeMapper.updateById(wrkCharge) > 0) {
+                    //涓嬪彂浠诲姟
+                    MessageQueue.offer(SlaveType.Lift, liftProtocol.getLiftNo().intValue(), new Task(3, assignCommand));
+                }
+
+            }else if(wrkCharge.getWrkSts() == 55){//55.鎻愬崌鏈鸿縼绉诲皬杞﹀畬鎴�
                 //鐩存帴璁$畻杞﹀埌鍏呯數搴撲綅
 
                 ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
 
-                //鑾峰彇灏忚溅鍒板厖鐢靛簱浣嶈矾寰勬寚浠�
-                List<ShuttleCommand> commands = this.shuttleAssignCommand(currentLocNo, chargeLocNo, ShuttleTaskModeType.PAK_IN.id, assignCommand, shuttleThread);
+                Short liftLev = liftProtocol.getLev();
+                if (liftLev == null) {
+                    continue;
+                }
+                //鍒ゆ柇鎻愬崌鏈烘ゼ灞傛槸鍚﹀埌杈剧洰鏍囨ゼ灞�
+                if (liftLev.intValue() != chargeLocNoLev) {
+                    continue;//娌℃湁鍒拌揪鐩爣妤煎眰
+                }
+
+                //姝ゆ椂杞﹀湪鎻愬崌鏈哄唴閮紝涓嬭揪涓�姝ユ寚浠よ杞︾Щ鍔ㄥ埌鎻愬崌鏈哄彛
+                Integer staNo = Utils.levToOutInStaNo(liftLev >= 2 ? liftLev + 1 : liftLev);//绔欑偣鍙�
+                BasDevp basDevp = basDevpService.selectById(staNo);
+                if (basDevp == null) {
+                    continue;//绔欑偣涓嶅瓨鍦�
+                }
+
+                //鑾峰彇鎻愬崌鏈哄彛鍒板厖鐢靛簱浣嶈矾寰勬寚浠�
+                List<ShuttleCommand> commands = this.shuttleAssignCommand(basDevp.getLocNo(), chargeLocNo, NavigationMapType.NONE.id, assignCommand, shuttleThread);
+                if (commands == null) {
+                    continue;//鏈壘鍒拌矾寰�
+                }
+
+                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);
 
@@ -2468,337 +2716,40 @@
                     //涓嬪彂浠诲姟
                     MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
                 }
-            }else {
-                //涓嶅悓灞傦紝灏嗙洰鏍囧簱浣嶅垎閰嶆垚鎻愬崌鏈哄簱浣嶅彿
+            }else if (wrkCharge.getWrkSts() == 57) {//57.灏忚溅鍒拌揪鍏呯數妗�
+                //鍏呯數涓�
+                //鍒ゆ柇灏忚溅鏄惁鍏呮弧鐢甸噺锛屾弧鐢�1000鎴栫數鍘�54V浠ヤ笂
+                if (shuttleProtocol.getBatteryPower() >= 1000 && shuttleProtocol.getCurrentVoltage() >= 54000) {
+                    //鍏呮弧锛屾柇寮�鍏呯數
+                    List<ShuttleCommand> commands = new ArrayList<>();
+                    ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
+                    assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());
+                    assignCommand.setTaskMode((short) 0);
+                    assignCommand.setTaskNo(wrkCharge.getWrkNo().shortValue());
+                    assignCommand.setCharge(true);
 
-                ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
+                    //鍒涘缓鍏呯數鎸囦护
+                    ShuttleCommand command = shuttleThread.getChargeSwitchCommand((short) 2);//鏂紑鍏呯數
+                    commands.add(command);
 
-                //灏忚溅绉诲姩鍒版彁鍗囨満鍙o紝璁$畻璺緞
-                List<ShuttleCommand> commands = this.shuttleAssignCommand(currentLocNo, liftLocNo, ShuttleTaskModeType.PAK_IN.id, assignCommand, shuttleThread);
-                //鍒嗛厤鐩爣搴撲綅
-                shuttleProtocol.setLocNo(liftLocNo);
+                    //鎸囦护闆嗗垎閰�
+                    assignCommand.setCommands(commands);
 
+                    shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.CHARGING_WAITING);
 
-                assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());
-                assignCommand.setTaskMode((short) 9);//鍏呯數
-                assignCommand.setTaskNo(wrkCharge.getWrkNo().shortValue());
-                assignCommand.setCharge(true);//鍏呯數浠诲姟
-                //鐩爣搴撲綅
-                assignCommand.setLocNo(liftLocNo);
-                //婧愬簱浣�
-                assignCommand.setSourceLocNo(currentLocNo);
-                assignCommand.setCommands(commands);
-                wrkCharge.setWrkSts(52L);//灏忚溅杩佺Щ鐘舵��
-                if (wrkChargeMapper.updateById(wrkCharge) > 0) {
-                    //涓嬪彂浠诲姟
-                    MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
+                    wrkCharge.setWrkSts(60L);//60.鍏呯數浠诲姟瀹屾垚
+                    if (wrkChargeMapper.updateById(wrkCharge) > 0) {
+                        //涓嬪彂浠诲姟
+                        MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
+                    }
                 }
-            }
 
-        }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;
-            }
-
-            //缁欐彁鍗囨満鍒嗛厤浠诲姟
-            liftProtocol.setLiftLock(true);//閿佸畾鎻愬崌鏈�
-            liftProtocol.setTaskNo(wrkCharge.getWrkNo().shortValue());//璁剧疆浠诲姟鍙�
-            liftProtocol.setShuttleNo(wrkCharge.getShuttleNo().shortValue());//璁剧疆鍥涘悜绌挎杞﹀彿
-            liftProtocol.setProtocolStatus(LiftProtocolStatusType.WORKING);//璁剧疆鎻愬崌鏈虹姸鎬佷负宸ヤ綔涓�
-
-            //鍛戒护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
-
-            wrkCharge.setWrkSts(54L);//鎻愬崌鏈烘惉杩愪腑
-            //鎵�闇�鍛戒护缁勫悎瀹屾瘯锛屾洿鏂版暟鎹簱锛屾彁浜ゅ埌绾跨▼鍘诲伐浣�
-            LiftAssignCommand assignCommand = new LiftAssignCommand();
-            assignCommand.setCommands(commands);
-            assignCommand.setLiftNo(liftProtocol.getLiftNo());
-            assignCommand.setTaskNo(liftProtocol.getTaskNo());
-            if (wrkChargeMapper.updateById(wrkCharge) > 0) {
-                //涓嬪彂浠诲姟
-                MessageQueue.offer(SlaveType.Lift, liftProtocol.getLiftNo().intValue(), new Task(3, assignCommand));
-            }
-
-        } else if (wrkCharge.getWrkSts() == 56) {
-            //鍏呯數涓�
-            //鍒ゆ柇灏忚溅鏄惁鍏呮弧鐢甸噺锛屾弧鐢�1000鎴栫數鍘�54V浠ヤ笂
-            if (shuttleProtocol.getBatteryPower() >= 1000 || shuttleProtocol.getCurrentVoltage() >= 540) {
-                //鍏呮弧锛屾柇寮�鍏呯數
-                List<ShuttleCommand> commands = new ArrayList<>();
-                ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
-                assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());
-                assignCommand.setTaskMode((short) 0);
-                assignCommand.setTaskNo(wrkCharge.getWrkNo().shortValue());
-                assignCommand.setCharge(true);
-
-                //鍒涘缓鍏呯數鎸囦护
-                ShuttleCommand command = shuttleThread.getChargeSwitchCommand((short) 2);//鏂紑鍏呯數
-                commands.add(command);
-
-                //鎸囦护闆嗗垎閰�
-                assignCommand.setCommands(commands);
-
-                shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.CHARGING_WAITING);
-                //涓嬪彂浠诲姟
-                MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
-            }
-
-            if (shuttleProtocol.getProtocolStatus() == ShuttleProtocolStatusType.CHARGING_WAITING.id) {
-                shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.CHARGING);
+                if (shuttleProtocol.getProtocolStatus() == ShuttleProtocolStatusType.CHARGING_WAITING.id) {
+                    shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.CHARGING);
+                }
             }
         }
 
-    }
-
-    /**
-     * 杞鍏呯數妗╂槸鍚︽湁绌洪棽灏忚溅
-     */
-    @Deprecated
-    public synchronized void queryChargeLocOfComplete() {
-        // 涓庡厖鐢典换鍔′笉鍚屾杩涜
-        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()) {
-            Integer steNo = basSteService.hasCarOfLocNo(value.locNo);
-            if (steNo != null) {
-                SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, steNo);
-                SteProtocol steProtocol = steThread.getSteProtocol();
-                BasSte basSte = basSteService.selectById(steNo);
-                if (Cools.isEmpty(steProtocol, basSte)) {
-                    continue;
-                }
-                if (steProtocol.getCharge() < 99) {
-                    continue;
-                }
-                if (steProtocol.getMode() == 0) {
-                    continue;
-                }
-                if (!steProtocol.getStatusType().equals(SteStatusType.IDLE)) {
-                    continue;
-                }
-//                // 1鍙峰厖鐢垫々
-//                if (value.equals(SteChargeType.FIRST) && devpThread.charge0) {
-//                    continue;
-//                }
-//                // 2鍙峰厖鐢垫々
-//                if (value.equals(SteChargeType.SECOND) && devpThread.charge1) {
-//                    continue;
-//                }
-//                // 3鍙峰厖鐢垫々
-//                if (value.equals(SteChargeType.THIRD) && devpThread.charge2) {
-//                    continue;
-//                }
-//                // 灏忚溅鏄惁澶勪簬鍏呯數鐘舵��
-//                if (steProtocol.getChargeStatus() == 1) {
-//                    continue;
-//                }
-                // case 1 : 鑷姩鍏呯數寮�   棣堢數      脳
-                // case 2 : 鑷姩鍏呯數寮�   婊$數      鉁�
-                // case 3 : 鑷姩鍏呯數鍏�   棣堢數      鉁�
-                // case 4 : 鑷姩鍏呯數鍏�   婊$數      鉁�
-                if (basSte.getAutoCharge().equals("Y")
-                        && steProtocol.getCharge() < Float.parseFloat(basSte.getChargeLine())) {
-                    continue;
-                }
-
-                WrkCharge wrkCharge = wrkChargeService.selectWorking(steNo, WrkChargeType.reset);
-
-                if (wrkCharge == null) {
-                    // 寮�濮嬬┛姊溅澶嶄綅浠诲姟
-                    wrkCharge = new WrkCharge();
-                    wrkCharge.setSteNo(steNo);
-                    wrkCharge.setWrkNo(commonService.getChargeWorkNo(6));
-                    wrkCharge.setWrkSts(41L);   // 41.灏忚溅鍑嗗澶嶄綅
-                    wrkCharge.setCrnNo(2);  // 鍥哄畾2鍙峰爢鍨涙満
-                    wrkCharge.setIoPri((double) 10);
-                    wrkCharge.setSourceLocNo(value.locNo);
-                    wrkCharge.setLocNo(basSte.getIdleLoc());
-                    wrkCharge.setMemo("reset");
-                    wrkCharge.setAppeTime(new Date());
-                    if (!wrkChargeService.insert(wrkCharge)) {
-                        News.error("淇濆瓨{}鍙风┛姊溅澶嶄綅浠诲姟澶辫触!!!", steNo);
-                    } else {
-                        break;
-                    }
-                }
-            }
-        }
-    }
-
-    /**
-     * 灏忚溅浠庡厖鐢垫々 鑷� 寰呮満搴撲綅
-     */
-    @Deprecated
-    public synchronized void steFromChargeToIdleLoc() {
-        WrkCharge wrkCharge = wrkChargeService.selectWorking(null, WrkChargeType.reset);
-        if (wrkCharge == null) { return; }
-        SteThread steThread = (SteThread) SlaveConnection.get(SlaveType.Ste, wrkCharge.getSteNo());
-        SteProtocol steProtocol = steThread.getSteProtocol();
-        BasSte basSte = basSteService.selectById(wrkCharge.getSteNo());
-        if (Cools.isEmpty(steProtocol, basSte)) {
-            return;
-        }
-        // 鎼繍鑷冲浐瀹氶�氶亾
-        if (wrkCharge.getWrkSts() == 41L) {
-            // 鎼皬杞﹁嚦灏忚溅璧板悜閫氶亾
-            List<String> channel = slaveProperties.getChannel();
-            for (String channelLocNo : channel) {
-                Integer otherSte = existOtherSte(channelLocNo, wrkCharge.getSteNo());
-                if (null != otherSte) {
-                    News.warn("{}鍙峰皬杞︾Щ鍏}搴撲綅缁勫け璐ワ紝鍘熷洜锛氬瓨鍦▄}鍙风┛姊溅锛�", wrkCharge.getSteNo(), channelLocNo, otherSte);
-                } else {
-                    // 鍥哄畾鍫嗗灈鏈�
-                    int crnNo = 1;
-                    if (null != wrkMastMapper.selectWorkingByCrn(crnNo)) {
-                        return;
-                    }
-
-                    LocMast channelLoc = locMastService.selectById(channelLocNo);
-
-                    CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn, crnNo);
-                    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.setTaskNo(wrkCharge.getWrkNo().shortValue()); // 宸ヤ綔鍙�
-                        crnCommand.setAckFinish((short) 0);  // 浠诲姟瀹屾垚纭浣�
-                        crnCommand.setTaskMode(CrnTaskModeType.STE_MOVE); // 浠诲姟妯″紡:  搴撲綅绉昏浆
-                        crnCommand.setSourcePosX(steProtocol.getRow());     // 婧愬簱浣嶆帓
-                        crnCommand.setSourcePosY(steProtocol.getBay());     // 婧愬簱浣嶅垪
-                        crnCommand.setSourcePosZ(steProtocol.getLev());     // 婧愬簱浣嶅眰
-                        crnCommand.setDestinationPosX(Utils.getGroupRow(channelLoc.getLocNo(), false).shortValue());     // 鐩爣搴撲綅鎺�
-                        crnCommand.setDestinationPosY(channelLoc.getBay1().shortValue());     // 鐩爣搴撲綅鍒�
-                        crnCommand.setDestinationPosZ(channelLoc.getLev1().shortValue());     // 鐩爣搴撲綅灞�
-                        if (!MessageQueue.offer(SlaveType.Crn, crnNo, new Task(2, crnCommand))) {
-                            News.error("鍫嗗灈鏈哄懡浠や笅鍙戝け璐ワ紝鍫嗗灈鏈哄彿={}锛屼换鍔℃暟鎹�={}", wrkCharge.getCrnNo(), JSON.toJSON(crnCommand));
-                        } else {
-                            // 淇敼绌挎杞﹁繍琛屼腑鎺掑垪灞�
-                            steThread.modifyPos(Utils.getGroupRow(channelLoc.getLocNo(), false), channelLoc.getBay1(), channelLoc.getLev1());
-                            // 淇敼宸ヤ綔妗g姸鎬� 41.灏忚溅鍑嗗澶嶄綅 => 42.鍚婅溅鎼繍
-                            Date now = new Date();
-                            wrkCharge.setWrkSts(42L);
-                            wrkCharge.setCrnStrTime(now);
-                            wrkCharge.setModiTime(now);
-                            if (!wrkChargeService.updateById(wrkCharge)) {
-                                News.error("淇敼澶嶄綅浠诲姟鐘舵�� 41.灏忚溅鍑嗗澶嶄綅 => 42.鍚婅溅鎼繍 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkCharge.getWrkNo());
-                            }
-                        }
-                        break;
-                    }
-
-                }
-            }
-        } else if (wrkCharge.getWrkSts() == 43L) {
-            // 灏忚溅琛岄┒閫氶亾
-            if (steProtocol.statusType.equals(SteStatusType.IDLE) && steProtocol.getPakMk().equals("N")) {
-                // 鍛戒护涓嬪彂鍖� --------------------------------------------------------------------------
-                SteCommand steCommand = new SteCommand();
-                steCommand.setSteNo(wrkCharge.getSteNo()); // 绌挎杞︾紪鍙�
-                steCommand.setTaskNo(wrkCharge.getWrkNo()); // 宸ヤ綔鍙�
-                steCommand.setTaskMode(SteTaskModeType.BACK_ORIGIN);  // 鍘诲乏绔�
-
-                steCommand.setRow(Utils.getGroupRow(steProtocol.getRow().intValue(), true).shortValue());
-                steCommand.setBay(steProtocol.getBay());
-                steCommand.setLev(steProtocol.getLev());
-                if (!MessageQueue.offer(SlaveType.Ste, wrkCharge.getSteNo(), new Task(2, steCommand))) {
-                    News.error("绌挎杞﹀懡浠や笅鍙戝け璐ワ紝绌挎杞﹀彿={}锛屼换鍔℃暟鎹�={}", wrkCharge.getSteNo(), JSON.toJSON(steCommand));
-                } else {
-                    // 淇敼宸ヤ綔妗g姸鎬� 43.灏忚溅鍒拌揪 ===> 44.灏忚溅璧拌
-                    wrkCharge.setWrkSts(44L);
-                    Date now = new Date();
-                    wrkCharge.setCrnEndTime(now);
-                    wrkCharge.setModiTime(now);
-                    if (!wrkChargeService.updateById(wrkCharge)) {
-                        News.error("淇敼澶嶄綅浠诲姟鐘舵�� 43.灏忚溅鍒拌揪 ===> 44.灏忚溅璧拌 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkCharge.getWrkNo());
-                    }
-                }
-            }
-        } else if (wrkCharge.getWrkSts() == 45L) {
-            if (null != wrkMastMapper.selectWorkingByCrn(wrkCharge.getCrnNo())) {
-                return;
-            }
-
-            LocMast idleLoc = locMastService.selectById(basSte.getIdleLoc());
-
-            Integer otherSte = existOtherSte(idleLoc.getLocNo(), wrkCharge.getSteNo());
-            if (null != otherSte) {
-                News.warn("{}鍙峰皬杞︾Щ鍏}搴撲綅缁勫け璐ワ紝鍘熷洜锛氬瓨鍦▄}鍙风┛姊溅锛�", wrkCharge.getSteNo(), idleLoc.getLocNo(), otherSte);
-            } else {
-                CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn, wrkCharge.getCrnNo());
-                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(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(idleLoc.getLocNo(), true).shortValue());     // 鐩爣搴撲綅鎺�
-                    crnCommand.setDestinationPosY(idleLoc.getBay1().shortValue());     // 鐩爣搴撲綅鍒�
-                    crnCommand.setDestinationPosZ(idleLoc.getLev1().shortValue());     // 鐩爣搴撲綅灞�
-                    if (!MessageQueue.offer(SlaveType.Crn, wrkCharge.getCrnNo(), new Task(2, crnCommand))) {
-                        News.error("鍫嗗灈鏈哄懡浠や笅鍙戝け璐ワ紝鍫嗗灈鏈哄彿={}锛屼换鍔℃暟鎹�={}", wrkCharge.getCrnNo(), JSON.toJSON(crnCommand));
-                    } else {
-                        // 淇敼绌挎杞﹁繍琛屼腑鎺掑垪灞�
-                        steThread.modifyPos(Utils.getGroupRow(idleLoc.getLocNo(), true), idleLoc.getBay1(), idleLoc.getLev1());
-                        // 淇敼宸ヤ綔妗g姸鎬� 45.灏忚溅寰呮惉 => 46.鏀捐嚦寰呮満浣�
-                        Date now = new Date();
-                        wrkCharge.setWrkSts(46L);
-                        wrkCharge.setCrnStrTime(now);
-                        wrkCharge.setModiTime(now);
-                        if (!wrkChargeService.updateById(wrkCharge)) {
-                            News.error("淇敼宸ヤ綔妗g姸鎬� 45.灏忚溅寰呮惉 => 46.鏀捐嚦寰呮満浣� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkCharge.getWrkNo());
-                        }
-                    }
-                }
-
-            }
-        }
     }
 
     public List<String> crn2DemoLocs = new ArrayList<String>(); public String crn2LastLoc = "";

--
Gitblit v1.9.1