From ee5e6e5d4714358de0371f83d02739cb765b4dbf Mon Sep 17 00:00:00 2001
From: Junjie <fallin.jie@qq.com>
Date: 星期六, 01 七月 2023 08:18:29 +0800
Subject: [PATCH] fixed

---
 src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java |  689 +++++++++++++++++++++++++++++++++------------------------
 1 files changed, 400 insertions(+), 289 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 a2060cb..f9bc9dc 100644
--- a/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java
+++ b/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java
@@ -673,15 +673,31 @@
                     if (wrkMast != null) {
                         if (wrkMast.getWrkSts() == 4 || wrkMast.getWrkSts() == 8) {
                             ShuttleThread shuttleThread = null;
+                            ShuttleProtocol shuttleProtocol = null;
                             HashMap<String, Object> searchIdleShuttle = null;
 
                             LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, 1);
                             LiftProtocol liftProtocol = liftThread.getLiftProtocol();
 
                             if (wrkMast.getWrkSts() == 4) {
-                                //瀵绘壘鏈�杩戜笖绌洪棽鐨勫洓鍚戠┛姊溅
-                                searchIdleShuttle = this.searchIdleShuttle(wrkMast);
-                                shuttleThread = (ShuttleThread) searchIdleShuttle.get("result");
+                                if (wrkMast.getShuttleNo() == null) {
+                                    //瀵绘壘鏈�杩戜笖绌洪棽鐨勫洓鍚戠┛姊溅
+                                    searchIdleShuttle = this.searchIdleShuttle(wrkMast);
+                                    shuttleThread = (ShuttleThread) searchIdleShuttle.get("result");
+                                    wrkMast.setShuttleNo(shuttleThread.getSlave().getId());//缁欏伐浣滄。鍒嗛厤鍥涘悜绌挎杞﹀彿
+                                    wrkMastMapper.updateById(wrkMast);
+                                    shuttleProtocol = shuttleThread.getShuttleProtocol();
+                                    if (!shuttleProtocol.isIdle()) {
+                                        continue;
+                                    }
+                                }else {
+                                    //鐩存帴浣跨敤浠诲姟淇濆瓨涓殑灏忚溅
+                                    shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo());
+                                    shuttleProtocol = shuttleThread.getShuttleProtocol();
+                                    if (!shuttleProtocol.isIdle(workNo)) {
+                                        continue;
+                                    }
+                                }
                             }else if(wrkMast.getWrkSts() == 8){//鐘舵��8锛岄渶瑕佸悜灏忚溅涓嬪彂鍛戒护浠庢彁鍗囨満绉诲姩鍑哄幓锛岄渶瑕佸垽鏂彁鍗囨満鐘舵槸鍚︾┖闂层�佹彁鍗囨満鏄惁鍒拌揪鐩爣妤煎眰銆佺洰鏍囨ゼ灞傜珯鐐规槸鍚﹀瓨鍦ㄣ�佺洰鏍囨ゼ灞傜珯鐐规槸鍚︾粰鍑烘彁鍗囨満鍒颁綅淇″彿
                                 //鐘舵��8锛岀瓑寰呭懡浠よ繘琛屽叆搴撴惉杩愬姩浣�
 
@@ -719,14 +735,17 @@
 
                                 Integer shuttleNo = wrkMast.getShuttleNo();//鍥涘悜绌挎杞﹀彿
                                 shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttleNo);
+                                shuttleProtocol = shuttleThread.getShuttleProtocol();
+                                if (!shuttleProtocol.isIdle(workNo)) {
+                                    continue;
+                                }
                             }
 
                             if (shuttleThread == null) {
                                 continue;
                             }
 
-                            ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
-                            if (!shuttleProtocol.isIdle()) {
+                            if (shuttleProtocol == null) {
                                 continue;
                             }
 
@@ -751,55 +770,118 @@
                             //鎻愬崌鏈哄彛绔欑偣搴撲綅鍙�
                             String liftSiteLocNo = Utils.levToOutInStaLocNo(currentLev);
 
-                            if (wrkMast.getWrkSts() == 8 || Boolean.parseBoolean(searchIdleShuttle.get("sameLay").toString())) {
-                                //鍚屼竴灞傜洿鎺ュ彇璐ф棤闇�缁忚繃鎻愬崌鏈�
+                            if (wrkMast.getWrkSts() == 4) {
+                                if (currentLev == Utils.getLev(locNo)) {
+                                    //灏忚溅鍜岀洰鏍囧湪鍚屼竴妤煎眰
+                                    //鐩存帴璁$畻杞﹀埌鎻愬崌鏈哄彇璐у啀鍒板簱浣嶈矾寰勬寚浠�
+                                    List<ShuttleCommand> commands = this.shuttleAssignCommand(wrkMast.getWrkSts() == 4 ? currentLocNo : liftSiteLocNo, liftSiteLocNo, locNo, assignCommand, shuttleThread);
+                                    if (commands == null) {
+                                        continue;//鎵句笉鍒拌矾寰勭瓑寰呬笅涓�娆�
+                                    }
+                                    assignCommand.setCommands(commands);
+                                    //鍒嗛厤鐩爣搴撲綅
+                                    shuttleProtocol.setLocNo(wrkMast.getLocNo());
+                                    //鐩爣搴撲綅
+                                    assignCommand.setLocNo(wrkMast.getLocNo());
+                                    wrkMast.setWrkSts(9L);//灏忚溅鍏ュ簱涓�
+                                }else {
+                                    //灏忚溅鍜岀洰鏍囦笉鍦ㄥ悓涓�妤煎眰
+                                    //灏忚溅绉诲姩鍒版彁鍗囨満鍙o紝璁$畻璺緞
+                                    List<ShuttleCommand> commands = this.shuttleAssignCommand(currentLocNo, liftSiteLocNo, NavigationMapType.NONE.id, assignCommand, shuttleThread);
+                                    if (commands == null) {
+                                        continue;//鏈壘鍒拌矾寰�
+                                    }
+
+                                    //鑾峰彇褰撳墠灏忚溅鎵�鍦ㄦゼ灞傜殑绔欑偣淇℃伅
+                                    BasDevp basDevp = basDevpService.queryByLocNo(liftSiteLocNo);
+                                    Short endStartCode = Short.parseShort(basDevp.getQrCodeValue());//绔欑偣浜岀淮鐮�
+
+                                    //澧炲姞绉诲姩杩涙彁鍗囨満鍛戒护
+                                    ShuttleCommand moveCommand = shuttleThread.getMoveCommand(endStartCode, liftProtocol.getBarcode(), 1400, ShuttleRunDirection.TOP.id, endStartCode, 1400, 500);
+                                    commands.add(moveCommand);
+
+                                    //鍒嗛厤鐩爣搴撲綅
+                                    shuttleProtocol.setLocNo(liftSiteLocNo);
+                                    //鐩爣搴撲綅
+                                    assignCommand.setLocNo(liftSiteLocNo);
+                                    assignCommand.setCommands(commands);
+                                    wrkMast.setWrkSts(5L);//灏忚溅杩佺Щ鐘舵��
+                                }
+                            } else if (wrkMast.getWrkSts() == 8) {
                                 //鐩存帴璁$畻杞﹀埌鎻愬崌鏈哄彇璐у啀鍒板簱浣嶈矾寰勬寚浠�
                                 List<ShuttleCommand> commands = this.shuttleAssignCommand(wrkMast.getWrkSts() == 4 ? currentLocNo : liftSiteLocNo, liftSiteLocNo, locNo, assignCommand, shuttleThread);
                                 if (commands == null) {
                                     continue;//鎵句笉鍒拌矾寰勭瓑寰呬笅涓�娆�
                                 }
-                                if (wrkMast.getWrkSts() == 8) {
-                                    //姝ゆ椂杞﹀湪鎻愬崌鏈哄唴閮紝涓嬭揪涓�姝ユ寚浠よ杞︾Щ鍔ㄥ埌鎻愬崌鏈哄彛
-                                    Integer staNo = Utils.levToOutInStaNo(currentLev >= 2 ? currentLev + 1 : currentLev);//绔欑偣鍙�
-                                    BasDevp basDevp = basDevpService.selectById(staNo);
 
-                                    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);//灏嗚鎸囦护娣诲姞鍒伴槦澶�
-                                }
+                                //姝ゆ椂杞﹀湪鎻愬崌鏈哄唴閮紝涓嬭揪涓�姝ユ寚浠よ杞︾Щ鍔ㄥ埌鎻愬崌鏈哄彛
+                                Integer staNo = Utils.levToOutInStaNo(currentLev >= 2 ? currentLev + 1 : currentLev);//绔欑偣鍙�
+                                BasDevp basDevp = basDevpService.selectById(staNo);
+
+                                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);//灏嗚鎸囦护娣诲姞鍒伴槦澶�
+
                                 assignCommand.setCommands(commands);
                                 //鍒嗛厤鐩爣搴撲綅
                                 shuttleProtocol.setLocNo(wrkMast.getLocNo());
                                 //鐩爣搴撲綅
                                 assignCommand.setLocNo(wrkMast.getLocNo());
                                 wrkMast.setWrkSts(9L);//灏忚溅鍏ュ簱涓�
-                            }else {
-                                //涓嶅悓灞傦紝灏嗙洰鏍囧簱浣嶅垎閰嶆垚鎻愬崌鏈哄簱浣嶅彿
-
-                                //灏忚溅绉诲姩鍒版彁鍗囨満鍙o紝璁$畻璺緞
-                                List<ShuttleCommand> commands = this.shuttleAssignCommand(currentLocNo, liftSiteLocNo, NavigationMapType.NONE.id, assignCommand, shuttleThread);
-                                if (commands == null) {
-                                    continue;//鏈壘鍒拌矾寰�
-                                }
-
-                                //鑾峰彇褰撳墠灏忚溅鎵�鍦ㄦゼ灞傜殑绔欑偣淇℃伅
-                                BasDevp basDevp = basDevpService.queryByLocNo(liftSiteLocNo);
-                                Short endStartCode = Short.parseShort(basDevp.getQrCodeValue());//绔欑偣浜岀淮鐮�
-
-                                //澧炲姞绉诲姩杩涙彁鍗囨満鍛戒护
-                                ShuttleCommand moveCommand = shuttleThread.getMoveCommand(endStartCode, liftProtocol.getBarcode(), 1400, ShuttleRunDirection.TOP.id, endStartCode, 1400, 500);
-                                commands.add(moveCommand);
-
-                                //鍒嗛厤鐩爣搴撲綅
-                                shuttleProtocol.setLocNo(liftSiteLocNo);
-                                //鐩爣搴撲綅
-                                assignCommand.setLocNo(liftSiteLocNo);
-                                assignCommand.setCommands(commands);
-                                wrkMast.setWrkSts(5L);//灏忚溅杩佺Щ鐘舵��
                             }
+
+//                            if (wrkMast.getWrkSts() == 8 || Boolean.parseBoolean(searchIdleShuttle.get("sameLay").toString())) {
+//                                //鍚屼竴灞傜洿鎺ュ彇璐ф棤闇�缁忚繃鎻愬崌鏈�
+//                                //鐩存帴璁$畻杞﹀埌鎻愬崌鏈哄彇璐у啀鍒板簱浣嶈矾寰勬寚浠�
+//                                List<ShuttleCommand> commands = this.shuttleAssignCommand(wrkMast.getWrkSts() == 4 ? currentLocNo : liftSiteLocNo, liftSiteLocNo, locNo, assignCommand, shuttleThread);
+//                                if (commands == null) {
+//                                    continue;//鎵句笉鍒拌矾寰勭瓑寰呬笅涓�娆�
+//                                }
+//                                if (wrkMast.getWrkSts() == 8) {
+//                                    //姝ゆ椂杞﹀湪鎻愬崌鏈哄唴閮紝涓嬭揪涓�姝ユ寚浠よ杞︾Щ鍔ㄥ埌鎻愬崌鏈哄彛
+//                                    Integer staNo = Utils.levToOutInStaNo(currentLev >= 2 ? currentLev + 1 : currentLev);//绔欑偣鍙�
+//                                    BasDevp basDevp = basDevpService.selectById(staNo);
+//
+//                                    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);//灏嗚鎸囦护娣诲姞鍒伴槦澶�
+//                                }
+//                                assignCommand.setCommands(commands);
+//                                //鍒嗛厤鐩爣搴撲綅
+//                                shuttleProtocol.setLocNo(wrkMast.getLocNo());
+//                                //鐩爣搴撲綅
+//                                assignCommand.setLocNo(wrkMast.getLocNo());
+//                                wrkMast.setWrkSts(9L);//灏忚溅鍏ュ簱涓�
+//                            }else {
+//                                //涓嶅悓灞傦紝灏嗙洰鏍囧簱浣嶅垎閰嶆垚鎻愬崌鏈哄簱浣嶅彿
+//
+//                                //灏忚溅绉诲姩鍒版彁鍗囨満鍙o紝璁$畻璺緞
+//                                List<ShuttleCommand> commands = this.shuttleAssignCommand(currentLocNo, liftSiteLocNo, NavigationMapType.NONE.id, assignCommand, shuttleThread);
+//                                if (commands == null) {
+//                                    continue;//鏈壘鍒拌矾寰�
+//                                }
+//
+//                                //鑾峰彇褰撳墠灏忚溅鎵�鍦ㄦゼ灞傜殑绔欑偣淇℃伅
+//                                BasDevp basDevp = basDevpService.queryByLocNo(liftSiteLocNo);
+//                                Short endStartCode = Short.parseShort(basDevp.getQrCodeValue());//绔欑偣浜岀淮鐮�
+//
+//                                //澧炲姞绉诲姩杩涙彁鍗囨満鍛戒护
+//                                ShuttleCommand moveCommand = shuttleThread.getMoveCommand(endStartCode, liftProtocol.getBarcode(), 1400, ShuttleRunDirection.TOP.id, endStartCode, 1400, 500);
+//                                commands.add(moveCommand);
+//
+//                                //鍒嗛厤鐩爣搴撲綅
+//                                shuttleProtocol.setLocNo(liftSiteLocNo);
+//                                //鐩爣搴撲綅
+//                                assignCommand.setLocNo(liftSiteLocNo);
+//                                assignCommand.setCommands(commands);
+//                                wrkMast.setWrkSts(5L);//灏忚溅杩佺Щ鐘舵��
+//                            }
 
                             if (wrkMastMapper.updateById(wrkMast) > 0) {
                                 //涓嬪彂浠诲姟
@@ -994,9 +1076,19 @@
                     LiftProtocol liftProtocol = liftThread.getLiftProtocol();
 
                     if (wrkMast.getWrkSts() == 21) {
-                        //瀵绘壘鏈�杩戜笖绌洪棽鐨勫洓鍚戠┛姊溅
-                        searchIdleShuttle = this.searchIdleShuttle(wrkMast);
-                        shuttleThread = (ShuttleThread) searchIdleShuttle.get("result");
+                        if (wrkMast.getShuttleNo() == null) {
+                            //瀵绘壘鏈�杩戜笖绌洪棽鐨勫洓鍚戠┛姊溅
+                            searchIdleShuttle = this.searchIdleShuttle(wrkMast);
+                            shuttleThread = (ShuttleThread) searchIdleShuttle.get("result");
+                            if (shuttleThread == null) {
+                                continue;
+                            }
+                            wrkMast.setShuttleNo(shuttleThread.getSlave().getId());//缁欏伐浣滄。鍒嗛厤鍥涘悜绌挎杞﹀彿
+                            wrkMastMapper.updateById(wrkMast);
+                        }else {
+                            //鐩存帴浣跨敤浠诲姟淇濆瓨涓殑灏忚溅
+                            shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo());
+                        }
                     }else if(wrkMast.getWrkSts() == 25) {//鐘舵��25锛岄渶瑕佸悜灏忚溅涓嬪彂鍛戒护浠庢彁鍗囨満绉诲姩鍑哄幓锛岄渶瑕佸垽鏂彁鍗囨満鐘舵槸鍚︾┖闂层�佹彁鍗囨満鏄惁鍒拌揪鐩爣妤煎眰銆佺洰鏍囨ゼ灞傜珯鐐规槸鍚﹀瓨鍦ㄣ�佺洰鏍囨ゼ灞傜珯鐐规槸鍚︾粰鍑烘彁鍗囨満鍒颁綅淇″彿
 
                         //鍒ゆ柇鎻愬崌鏈烘槸鍚︾┖闂�
@@ -1051,17 +1143,16 @@
                         continue;
                     }
 
-                    if (!shuttleProtocol.isIdle()) {
-                        continue;
-                    }
-
                     if (outStaLocNo == null) {
                         continue;
                     }
 
                     if (wrkMast.getWrkSts() == 21) {
 
-                        wrkMast.setShuttleNo(shuttleProtocol.getShuttleNo().intValue());//缁欏伐浣滄。鍒嗛厤鍥涘悜绌挎杞﹀彿
+                        if (!shuttleProtocol.isIdle()) {
+                            continue;
+                        }
+
                         //婧愬簱浣�(灏忚溅褰撳墠浣嶇疆)
                         String currentLocNo = shuttleProtocol.getCurrentLocNo();
 
@@ -1080,7 +1171,7 @@
                         assignCommand.setSourceLocNo(currentLocNo);
 
                         //鍒ゆ柇灏忚溅鍜屽簱浣嶆槸鍚﹀湪鍚屼竴灞�
-                        if (Boolean.parseBoolean(searchIdleShuttle.get("sameLay").toString())) {
+                        if (currentLev == Utils.getLev(wrkMast.getSourceLocNo())) {
                             //鍚屼竴灞�(灏嗗皬杞︾Щ鍔ㄥ埌璐х墿浣嶇疆)
 
                             List<ShuttleCommand> commands = this.shuttleAssignCommand(currentLocNo, wrkMast.getSourceLocNo(), liftSiteLocNo, assignCommand, shuttleThread);
@@ -1140,6 +1231,9 @@
                             }
                         }
                     } else if (wrkMast.getWrkSts() == 25) {
+                        if (!shuttleProtocol.isIdle(wrkMast.getWrkNo().shortValue())) {
+                            continue;
+                        }
 
                         wrkMast.setShuttleNo(shuttleProtocol.getShuttleNo().intValue());//缁欏伐浣滄。鍒嗛厤鍥涘悜绌挎杞﹀彿
 
@@ -1212,6 +1306,18 @@
             distLocNo = locNo;
         }
 
+        //鍒ゆ柇褰撳墠浠诲姟鎵�鍦ㄦゼ灞傛槸鍚︽湁鍏朵粬浠诲姟宸茬粡鍒嗛厤浜嗗皬杞︼紝濡傛湁鍒欑洿鎺ョ敤璇ュ皬杞�(涓�灞傛ゼ浠呭垎閰嶄竴鍙拌溅)
+        List<WrkMast> wrkMasts = wrkMastService.selectShuttleWrkByLev(lev);//鍒ゆ柇褰撳墠绌挎杞︽ゼ灞傛槸鍚﹀凡鏈夊垎閰嶈溅杈嗙殑浠诲姟锛屽鏋滄湁鍒欏垎閰嶈繖杈嗚溅
+        if (wrkMasts.size() > 0) {
+            //瀛樺湪鍏朵粬浠诲姟锛屽垎閰嶈繖杈嗚溅
+            WrkMast wrkMast1 = wrkMasts.get(0);
+            ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast1.getShuttleNo());
+
+            map.put("sameLay", true);//鍚屽眰
+            map.put("result", shuttleThread);
+            return map;
+        }
+
         for (ShuttleSlave shuttle : slaveProperties.getShuttle()) {
             //鑾峰彇鍥涘悜绌挎杞︾嚎绋�
             ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttle.getId());
@@ -1246,27 +1352,18 @@
 
         }
 
+        Integer recentAllDistance = 9999999;
         if (sameLev.size() > 0) {
             //鍚屼竴妤煎眰鏈夌┖闂茬┛姊溅锛屽垯鍙湪宸ヤ綔妗fゼ灞傚鎵�
             //瀵绘壘绂讳换鍔℃渶杩戠殑绌挎杞�
             for (ShuttleThread shuttleThread : sameLev) {
-                if (recentShuttle == null) {//鏈�杩戠┛姊溅涓虹┖锛屽垯榛樿璧嬩簣涓烘渶杩戠┛姊溅
-                    recentShuttle = shuttleThread;
-                }
-
                 //褰撳墠绌挎杞﹀簱浣嶅彿
                 String currentLocNo = shuttleThread.getShuttleProtocol().getCurrentLocNo();
-                //鐩墠鏈�杩戠┛姊溅搴撲綅鍙�
-                String recentLocNo = recentShuttle.getShuttleProtocol().getCurrentLocNo();
-
-                //褰撳墠鏈�杩戝洓鍚戠┛姊溅鍒扮洰鏍囧湴鐐硅窛绂�
-                List<NavigateNode> recentShuttlePath = NavigateUtils.calc(recentLocNo, distLocNo, NavigationMapType.NORMAL.id, Utils.getShuttlePoints(recentShuttle.getSlave().getId(), Utils.getLev(recentLocNo)));//鎼滅储绌洪棽绌挎杞︼紝浣跨敤姝e父閫氶亾鍦板浘
                 //褰撳墠绌挎杞︾嚎绋嬪埌鐩爣鍦扮偣璺濈
                 List<NavigateNode> currentShuttlePath = NavigateUtils.calc(currentLocNo, distLocNo, NavigationMapType.NORMAL.id, Utils.getShuttlePoints(shuttleThread.getSlave().getId(), Utils.getLev(currentLocNo)));//鎼滅储绌洪棽绌挎杞︼紝浣跨敤姝e父閫氶亾鍦板浘
-                if (recentShuttlePath == null || currentShuttlePath == null) {
+                if (currentShuttlePath == null) {
                     continue;
                 }
-                Integer recentAllDistance = NavigateUtils.getOriginPathAllDistance(recentShuttlePath);//璁$畻褰撳墠璺緞琛岃蛋鎬昏窛绂�
                 Integer currentAllDistance = NavigateUtils.getOriginPathAllDistance(currentShuttlePath);//璁$畻褰撳墠璺緞琛岃蛋鎬昏窛绂�
                 if (currentAllDistance < recentAllDistance) {
                     //濡傛灉褰撳墠妤煎眰鐨勮溅璺緞鏇村皬锛屽垯鏇存柊鏈�杩戠┛姊溅
@@ -1284,29 +1381,18 @@
                 //褰撳墠绌挎杞﹀簱浣嶅彿
                 String currentLocNo = shuttleThread.getShuttleProtocol().getCurrentLocNo();
                 int currentLev = Utils.getLev(currentLocNo);
-                List<LocMast> locMasts = wrkMastService.selectNoShuttleWrkByLev(currentLev);//鍒ゆ柇褰撳墠绌挎杞︽ゼ灞傛槸鍚︽湁寰呭垎閰嶈溅杈嗙殑浠诲姟锛屽鏋滄湁鍒欎笉鍒嗛厤杩欒締杞�
-                if (locMasts.size() > 0) {
+                List<WrkMast> wrkMasts1 = wrkMastService.selectNoShuttleWrkByLev(currentLev);//鍒ゆ柇褰撳墠绌挎杞︽ゼ灞傛槸鍚︽湁寰呭垎閰嶈溅杈嗙殑浠诲姟锛屽鏋滄湁鍒欎笉鍒嗛厤杩欒締杞�
+                if (wrkMasts1.size() > 0) {
                     //瀛樺湪鍏朵粬浠诲姟锛岃烦杩囪繖杈嗚溅
                     continue;
                 }
 
-                if (recentShuttle == null) {//鏈�杩戠┛姊溅涓虹┖锛屽垯榛樿璧嬩簣涓烘渶杩戠┛姊溅
-                    recentShuttle = shuttleThread;
-                }
-                //鐩墠鏈�杩戠┛姊溅搴撲綅鍙�
-                String recentLocNo = recentShuttle.getShuttleProtocol().getCurrentLocNo();
-                int recentLev = Utils.getLev(recentLocNo);
-
-
-                //褰撳墠鏈�杩戝洓鍚戠┛姊溅鍒板綋鍓嶈溅瀛愭墍鍦ㄦゼ灞傜殑鎻愬崌鏈哄彛璺濈
-                List<NavigateNode> recentShuttlePath = NavigateUtils.calc(recentLocNo, Utils.levToOutInStaLocNo(recentLev), NavigationMapType.NORMAL.id, Utils.getShuttlePoints(shuttleThread.getSlave().getId(), recentLev));//鎼滅储绌洪棽绌挎杞︼紝浣跨敤姝e父閫氶亾鍦板浘
                 //褰撳墠绌挎杞︾嚎绋嬪埌褰撳墠杞﹀瓙鎵�鍦ㄦゼ灞傜殑鎻愬崌鏈哄彛璺濈
                 List<NavigateNode> currentShuttlePath = NavigateUtils.calc(currentLocNo, Utils.levToOutInStaLocNo(currentLev), NavigationMapType.NORMAL.id, Utils.getShuttlePoints(shuttleThread.getSlave().getId(), currentLev));//鎼滅储绌洪棽绌挎杞︼紝浣跨敤姝e父閫氶亾鍦板浘
-                if (recentShuttlePath == null || currentShuttlePath == null) {
+                if (currentShuttlePath == null) {
                     continue;
                 }
 
-                Integer recentAllDistance = NavigateUtils.getOriginPathAllDistance(recentShuttlePath);//璁$畻褰撳墠璺緞琛岃蛋鎬昏窛绂�
                 Integer currentAllDistance = NavigateUtils.getOriginPathAllDistance(currentShuttlePath);//璁$畻褰撳墠璺緞琛岃蛋鎬昏窛绂�
                 if (currentAllDistance < recentAllDistance) {
                     //濡傛灉褰撳墠妤煎眰鐨勮溅璺緞鏇村皬锛屽垯鏇存柊鏈�杩戠┛姊溅
@@ -1349,6 +1435,8 @@
                     switch (wrkMast.getWrkSts().intValue()) {
                         case 9://9.灏忚溅鍏ュ簱鎼繍涓� ==> 14.鍏ュ簱瀹屾垚
                             wrkMast.setWrkSts(14L);
+                            //浠诲姟鍙锋竻闆�
+                            shuttleProtocol.setTaskNo((short) 0);
                             break;
                         case 5://5.杩佺Щ灏忚溅鑷虫彁鍗囨満鍙� ==> 6.杩佺Щ灏忚溅鑷虫彁鍗囨満鍙e畬鎴�
                             wrkMast.setWrkSts(6L);
@@ -1367,6 +1455,8 @@
                             }
 
                             wrkMast.setWrkSts(27L);
+                            //浠诲姟鍙锋竻闆�
+                            shuttleProtocol.setTaskNo((short) 0);
                             break;
                         default:
                     }
@@ -1374,8 +1464,6 @@
                     if (wrkMastMapper.updateById(wrkMast) > 0) {
                         //璁剧疆鍥涘悜绌挎杞︿负绌洪棽鐘舵��
                         shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.IDLE);
-                        //浠诲姟鍙锋竻闆�
-                        shuttleProtocol.setTaskNo((short) 0);
                         //婧愬簱浣嶆竻闆�
                         shuttleProtocol.setSourceLocNo(null);
                         //鐩爣搴撲綅娓呴浂
@@ -1386,9 +1474,14 @@
 
                         if (wrkMast.getWrkSts() == 27) {
                             if (moveAssignCommand != null) {
-                                //涓嬪彂浠诲姟
-                                shuttleProtocol.setPakMk(true);
-                                MessageQueue.offer(SlaveType.Shuttle, shuttleThread.getSlave().getId(), new Task(3, moveAssignCommand));
+                                try {
+                                    Thread.sleep(4000);
+                                    //涓嬪彂浠诲姟
+                                    shuttleProtocol.setPakMk(true);
+                                    MessageQueue.offer(SlaveType.Shuttle, shuttleThread.getSlave().getId(), new Task(3, moveAssignCommand));
+                                } catch (InterruptedException e) {
+                                    throw new RuntimeException(e);
+                                }
                             }
                         }
 
@@ -1485,240 +1578,253 @@
             }
 
             //鎼滅储鏄惁鏈夊緟澶勭悊鐨勪换鍔�
-            WrkMast wrkMast = wrkMastMapper.selectLiftStep262327();
-            if (wrkMast == null) {
+            List<WrkMast> wrkMasts = wrkMastMapper.selectLiftStep262327();
+            if (wrkMasts.size() == 0) {
                 continue;
             }
 
-            //鍛戒护list
-            ArrayList<LiftCommand> commands = new ArrayList<>();
-
-            DevpThread devpThread = null;
-            Integer devpId = null;
-            for (DevpSlave devp : slaveProperties.getDevp()){
-                // 鑾峰彇鍏ュ簱绔欎俊鎭�
-                devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, devp.getId());
-                devpId = devp.getId();
-            }
-
-            if (wrkMast.getWrkSts() == 2) {//2.璁惧涓婅蛋
-                if (liftProtocol.getTaskNo().intValue() != 0) {
-                    //瀛樺湪鏈畬鎴愪换鍔″彿
-                    continue;
-                }
-                if (liftProtocol.getPlatShuttleCheck()) {
-                    //鎻愬崌鏈烘鏃舵湁鍥涘悜杞︼紝鍙兘鏈夋湭瀹屾垚鐨勪换鍔★紝绂佹鍒嗛厤鏂颁换鍔�
+            for (WrkMast wrkMast : wrkMasts) {
+                //鎼滅储鏄惁鏈夊叾浠栦换鍔″崰鐢ㄤ簡鎻愬崌鏈猴紝濡傛灉鍗犵敤鎻愬崌鏈虹殑浠诲姟鍜屽綋鍓嶄换鍔$浉鍚岋紝鍒欒繍琛屾墽琛�
+                WrkMast wrkMast1 = wrkMastMapper.selectLiftWrkMast(liftProtocol.getLiftNo().intValue());
+                if (wrkMast1 != null && wrkMast1.getWrkNo().intValue() != wrkMast.getWrkNo().intValue()) {
                     continue;
                 }
 
-                //鑾峰彇鐩爣绔�
-                StaProtocol staProtocol = devpThread.getStation().get(wrkMast.getStaNo());
-                if (staProtocol.isLoading() || !staProtocol.isInEnable()) {//鐩爣绔欐湁鐗╋紝涓嶅彲鍏ワ紝绂佹鍒嗛厤浠诲姟
-                    continue;
+                //鍛戒护list
+                ArrayList<LiftCommand> commands = new ArrayList<>();
+
+                DevpThread devpThread = null;
+                Integer devpId = null;
+                for (DevpSlave devp : slaveProperties.getDevp()){
+                    // 鑾峰彇鍏ュ簱绔欎俊鎭�
+                    devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, devp.getId());
+                    devpId = devp.getId();
                 }
 
-                //宸ヤ綔妗g洰鏍囧簱浣嶅彿
-                String wrkMastLocNo = wrkMast.getLocNo();
-                //宸ヤ綔妗g洰鏍囧簱浣嶆ゼ灞�
-                int wrkMastLocNoLey = Utils.getLev(wrkMastLocNo);
+                if (wrkMast.getWrkSts() == 2) {//2.璁惧涓婅蛋
+                    if (liftProtocol.getTaskNo().intValue() != 0) {
+                        //瀛樺湪鏈畬鎴愪换鍔″彿
+                        continue;
+                    }
+                    if (liftProtocol.getPlatShuttleCheck()) {
+                        //鎻愬崌鏈烘鏃舵湁鍥涘悜杞︼紝鍙兘鏈夋湭瀹屾垚鐨勪换鍔★紝绂佹鍒嗛厤鏂颁换鍔�
+                        continue;
+                    }
 
-                Integer levTmp = wrkMastLocNoLey;
-                if (wrkMastLocNoLey >= 2) {
-                    levTmp += 1;
-                }
-                Integer distStaNo = Utils.levToOutInStaNo(levTmp);
+                    //鑾峰彇鐩爣绔�
+                    StaProtocol staProtocol = devpThread.getStation().get(wrkMast.getStaNo());
+                    if (staProtocol.isLoading() || !staProtocol.isInEnable()) {//鐩爣绔欐湁鐗╋紝涓嶅彲鍏ワ紝绂佹鍒嗛厤浠诲姟
+                        continue;
+                    }
 
-                if (liftProtocol.getPositionArrivalFeedback().intValue() != LiftLevType.TWO.realLev.intValue()) {
-                    //鎻愬崌鏈轰笉鍦ㄨ緭閫佺嚎妤煎眰锛岃幏鍙栧埌杈撻�佺嚎灞傜殑鎻愬崌鏈哄懡浠�
-                    LiftCommand command1 = liftThread.getLiftUpDownCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), LiftLevType.TWO.lev);
-                    commands.add(command1);//灏嗗懡浠ゆ坊鍔犺繘list
-                }
+                    //宸ヤ綔妗g洰鏍囧簱浣嶅彿
+                    String wrkMastLocNo = wrkMast.getLocNo();
+                    //宸ヤ綔妗g洰鏍囧簱浣嶆ゼ灞�
+                    int wrkMastLocNoLey = Utils.getLev(wrkMastLocNo);
 
-                //杈撻�佺嚎灏嗚揣鐗╄繍杩涙潵(鏃犺揣姝h浆)
-                LiftCommand command2 = liftThread.getLiftTurnCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), 3);
-                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;
+                    }
+                    Integer distStaNo = Utils.levToOutInStaNo(levTmp);
 
-                //鎻愬崌鏈哄墠寰�鐩爣妤煎眰(宸ヤ綔妗g洰鏍囨ゼ灞�)
-                LiftCommand command3 = liftThread.getLiftUpDownCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), levTmp);
-                commands.add(command3);//灏嗗懡浠ゆ坊鍔犺繘list
+                    if (liftProtocol.getPositionArrivalFeedback().intValue() != LiftLevType.TWO.realLev.intValue()) {
+                        //鎻愬崌鏈轰笉鍦ㄨ緭閫佺嚎妤煎眰锛岃幏鍙栧埌杈撻�佺嚎灞傜殑鎻愬崌鏈哄懡浠�
+                        LiftCommand command1 = liftThread.getLiftUpDownCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), LiftLevType.TWO.lev);
+                        commands.add(command1);//灏嗗懡浠ゆ坊鍔犺繘list
+                    }
 
-                //鎻愬崌鏈哄埌杈炬寚瀹氭ゼ灞傦紝杈撻�佺嚎灏嗚揣鐗╃Щ鍑哄幓(姝h浆)
-                //杈撻�佺嚎灏嗚揣鐗╃Щ鍑哄幓
-                LiftCommand command4 = liftThread.getLiftTurnCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), 1);
-                command4.setOperaStaNo(distStaNo.shortValue());//鎿嶄綔鐩爣妤煎眰绔欑偣
-                command4.setRotationDire(1);//缁欒緭閫佺嚎涓嬪彂閾炬潯杞姩淇″彿锛屾杞�
-                command4.setDevpId(devpId);
-                command4.setStaNo(distStaNo.shortValue());//璁剧疆鐩爣绔�
-                commands.add(command4);//灏嗗懡浠ゆ坊鍔犺繘list
+                    //杈撻�佺嚎灏嗚揣鐗╄繍杩涙潵(鏃犺揣姝h浆)
+                    LiftCommand command2 = liftThread.getLiftTurnCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), 3);
+                    command2.setOperaStaNo((short) 102);//鎿嶄綔102绔�
+                    command2.setRotationDire(1);//缁欒緭閫佺嚎涓嬪彂閾炬潯杞姩淇″彿锛屾杞�
+                    command2.setDevpId(devpId);
+                    command2.setStaNo(distStaNo.shortValue());//璁剧疆鐩爣绔�
+                    commands.add(command2);//灏嗗懡浠ゆ坊鍔犺繘list
 
-                //缁欐彁鍗囨満鍒嗛厤浠诲姟
-                liftProtocol.setTaskNo(wrkMast.getWrkNo().shortValue());//璁剧疆浠诲姟鍙�
-                liftProtocol.setProtocolStatus(LiftProtocolStatusType.WORKING);//璁剧疆鎻愬崌鏈虹姸鎬佷负宸ヤ綔涓�
+                    //鎻愬崌鏈哄墠寰�鐩爣妤煎眰(宸ヤ綔妗g洰鏍囨ゼ灞�)
+                    LiftCommand command3 = liftThread.getLiftUpDownCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), levTmp);
+                    commands.add(command3);//灏嗗懡浠ゆ坊鍔犺繘list
 
-                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());//璁剧疆鍥涘悜绌挎杞﹀彿
+                    //鎻愬崌鏈哄埌杈炬寚瀹氭ゼ灞傦紝杈撻�佺嚎灏嗚揣鐗╃Щ鍑哄幓(姝h浆)
+                    //杈撻�佺嚎灏嗚揣鐗╃Щ鍑哄幓
+                    LiftCommand command4 = liftThread.getLiftTurnCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), 1);
+                    command4.setOperaStaNo(distStaNo.shortValue());//鎿嶄綔鐩爣妤煎眰绔欑偣
+                    command4.setRotationDire(1);//缁欒緭閫佺嚎涓嬪彂閾炬潯杞姩淇″彿锛屾杞�
+                    command4.setDevpId(devpId);
+                    command4.setStaNo(distStaNo.shortValue());//璁剧疆鐩爣绔�
+                    commands.add(command4);//灏嗗懡浠ゆ坊鍔犺繘list
 
-                //鍒ゆ柇灏忚溅鏄惁鍦ㄦ彁鍗囨満鍐咃紝涓斿浜庣┖闂茬姸鎬�
-                ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo());
-                if (shuttleThread == null) {
-                    continue;
-                }
-                ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
-                if (shuttleProtocol == null) {
-                    continue;
-                }
-                if (!shuttleProtocol.isIdle()) {
-                    continue;//灏忚溅鐘舵�佸繖
-                }
-                if (shuttleProtocol.getCurrentCode().intValue() != liftProtocol.getBarcode().intValue()) {
-                    continue;//灏忚溅褰撳墠浜岀淮鐮佸拰鎻愬崌鏈哄唴閮ㄤ簩缁寸爜涓嶄竴鑷达紝涓嶅厑璁告墽琛�
-                }
-                if (!liftProtocol.getPlatShuttleCheck()) {
-                    //鎻愬崌鏈烘湭妫�娴嬪埌灏忚溅锛岀姝㈡墽琛�
-                    continue;
-                }
+                    //缁欐彁鍗囨満鍒嗛厤浠诲姟
+                    liftProtocol.setTaskNo(wrkMast.getWrkNo().shortValue());//璁剧疆浠诲姟鍙�
+                    liftProtocol.setProtocolStatus(LiftProtocolStatusType.WORKING);//璁剧疆鎻愬崌鏈虹姸鎬佷负宸ヤ綔涓�
 
-                //宸ヤ綔妗g洰鏍囧簱浣嶅彿
-                String wrkMastLocNo = wrkMast.getLocNo();
-                //宸ヤ綔妗g洰鏍囧簱浣嶆ゼ灞�
-                int wrkMastLocNoLey = Utils.getLev(wrkMastLocNo);
-                if (wrkMastLocNoLey >= 2) {
-                    wrkMastLocNoLey++;
-                }
+                    wrkMast.setLiftNo(liftProtocol.getLiftNo().intValue());//璁剧疆鎻愬崌鏈哄彿鐢ㄤ簬閿佸畾鎻愬崌鏈洪槻姝㈣鍏朵粬浠诲姟鍗犵敤
+                    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());//璁剧疆鍥涘悜绌挎杞﹀彿
 
-                //鎻愬崌鏈哄墠寰�鐩爣妤煎眰(宸ヤ綔妗g洰鏍囨ゼ灞�)
-                LiftCommand command1 = liftThread.getLiftUpDownCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), wrkMastLocNoLey);
-                commands.add(command1);//灏嗗懡浠ゆ坊鍔犺繘list
+                    //鍒ゆ柇灏忚溅鏄惁鍦ㄦ彁鍗囨満鍐咃紝涓斿浜庣┖闂茬姸鎬�
+                    ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo());
+                    if (shuttleThread == null) {
+                        continue;
+                    }
+                    ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
+                    if (shuttleProtocol == null) {
+                        continue;
+                    }
+                    if (!shuttleProtocol.isIdle(wrkMast.getWrkNo().shortValue())) {
+                        continue;//灏忚溅鐘舵�佸繖
+                    }
+                    if (shuttleProtocol.getCurrentCode().intValue() != liftProtocol.getBarcode().intValue()) {
+                        continue;//灏忚溅褰撳墠浜岀淮鐮佸拰鎻愬崌鏈哄唴閮ㄤ簩缁寸爜涓嶄竴鑷达紝涓嶅厑璁告墽琛�
+                    }
+                    if (!liftProtocol.getPlatShuttleCheck()) {
+                        //鎻愬崌鏈烘湭妫�娴嬪埌灏忚溅锛岀姝㈡墽琛�
+                        continue;
+                    }
 
-                //缁欐彁鍗囨満鍒嗛厤浠诲姟
-                liftProtocol.setTaskNo(wrkMast.getWrkNo().shortValue());//璁剧疆浠诲姟鍙�
-                liftProtocol.setProtocolStatus(LiftProtocolStatusType.WORKING);//璁剧疆鎻愬崌鏈虹姸鎬佷负宸ヤ綔涓�
+                    //宸ヤ綔妗g洰鏍囧簱浣嶅彿
+                    String wrkMastLocNo = wrkMast.getLocNo();
+                    //宸ヤ綔妗g洰鏍囧簱浣嶆ゼ灞�
+                    int wrkMastLocNoLey = Utils.getLev(wrkMastLocNo);
+                    if (wrkMastLocNoLey >= 2) {
+                        wrkMastLocNoLey++;
+                    }
 
-                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());//璁剧疆鍥涘悜绌挎杞﹀彿
-
-                //鍒ゆ柇灏忚溅鏄惁鍦ㄦ彁鍗囨満鍐咃紝涓斿浜庣┖闂茬姸鎬�
-                ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo());
-                if (shuttleThread == null) {
-                    continue;
-                }
-                ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
-                if (shuttleProtocol == null) {
-                    continue;
-                }
-
-                if (!shuttleProtocol.isIdle()) {
-                    continue;//灏忚溅鐘舵�佸繖
-                }
-                if (shuttleProtocol.getCurrentCode().intValue() != liftProtocol.getBarcode().intValue()) {
-                    continue;//灏忚溅褰撳墠浜岀淮鐮佸拰鎻愬崌鏈哄唴閮ㄤ簩缁寸爜涓嶄竴鑷达紝涓嶅厑璁告墽琛�
-                }
-                if (!liftProtocol.getPlatShuttleCheck()) {
-                    //鎻愬崌鏈烘湭妫�娴嬪埌灏忚溅锛岀姝㈡墽琛�
-                    continue;
-                }
-
-                //宸ヤ綔妗g洰鏍囧簱浣嶅彿
-                String wrkMastLocNo = wrkMast.getSourceLocNo();
-                //宸ヤ綔妗g洰鏍囧簱浣嶆ゼ灞�
-                int wrkMastLocNoLey = Utils.getLev(wrkMastLocNo);
-                if (wrkMastLocNoLey >= 2) {
-                    wrkMastLocNoLey++;
-                }
-
-                //鎻愬崌鏈哄墠寰�鐩爣妤煎眰(宸ヤ綔妗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(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簮搴撲綅妤煎眰
-                int wrkMastLocNoLey = Utils.getLev(wrkMastLocNo);
-
-                //鎻愬崌鏈哄綋鍓嶆ゼ灞�
-                int liftLev = liftProtocol.getLev().intValue();
-
-                //鍒ゆ柇鎻愬崌鏈烘槸鍚﹀埌浣�
-                StaProtocol staProtocol = devpThread.getStation().get(Utils.levToOutInStaNo(wrkMastLocNoLey >= 2 ? wrkMastLocNoLey + 1 : wrkMastLocNoLey));//璧峰绔欑偣
-                if (liftLev != wrkMastLocNoLey && !staProtocol.isLiftArrival()) {
-                    //鎻愬崌鏈轰笉鍦ㄥ伐浣滄。婧愬簱浣嶆ゼ灞傦紝璋冨害鎻愬崌鏈�
+                    //鎻愬崌鏈哄墠寰�鐩爣妤煎眰(宸ヤ綔妗g洰鏍囨ゼ灞�)
                     LiftCommand command1 = liftThread.getLiftUpDownCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), wrkMastLocNoLey);
                     commands.add(command1);//灏嗗懡浠ゆ坊鍔犺繘list
+
+                    //缁欐彁鍗囨満鍒嗛厤浠诲姟
+                    liftProtocol.setTaskNo(wrkMast.getWrkNo().shortValue());//璁剧疆浠诲姟鍙�
+                    liftProtocol.setProtocolStatus(LiftProtocolStatusType.WORKING);//璁剧疆鎻愬崌鏈虹姸鎬佷负宸ヤ綔涓�
+
+                    wrkMast.setLiftNo(liftProtocol.getLiftNo().intValue());//璁剧疆鎻愬崌鏈哄彿鐢ㄤ簬閿佸畾鎻愬崌鏈洪槻姝㈣鍏朵粬浠诲姟鍗犵敤
+                    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());//璁剧疆鍥涘悜绌挎杞﹀彿
+
+                    //鍒ゆ柇灏忚溅鏄惁鍦ㄦ彁鍗囨満鍐咃紝涓斿浜庣┖闂茬姸鎬�
+                    ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo());
+                    if (shuttleThread == null) {
+                        continue;
+                    }
+                    ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
+                    if (shuttleProtocol == null) {
+                        continue;
+                    }
+
+                    if (!shuttleProtocol.isIdle(wrkMast.getWrkNo().shortValue())) {
+                        continue;//灏忚溅鐘舵�佸繖
+                    }
+                    if (shuttleProtocol.getCurrentCode().intValue() != liftProtocol.getBarcode().intValue()) {
+                        continue;//灏忚溅褰撳墠浜岀淮鐮佸拰鎻愬崌鏈哄唴閮ㄤ簩缁寸爜涓嶄竴鑷达紝涓嶅厑璁告墽琛�
+                    }
+                    if (!liftProtocol.getPlatShuttleCheck()) {
+                        //鎻愬崌鏈烘湭妫�娴嬪埌灏忚溅锛岀姝㈡墽琛�
+                        continue;
+                    }
+
+                    //宸ヤ綔妗g洰鏍囧簱浣嶅彿
+                    String wrkMastLocNo = wrkMast.getSourceLocNo();
+                    //宸ヤ綔妗g洰鏍囧簱浣嶆ゼ灞�
+                    int wrkMastLocNoLey = Utils.getLev(wrkMastLocNo);
+                    if (wrkMastLocNoLey >= 2) {
+                        wrkMastLocNoLey++;
+                    }
+
+                    //鎻愬崌鏈哄墠寰�鐩爣妤煎眰(宸ヤ綔妗g洰鏍囨ゼ灞�)
+                    LiftCommand command1 = liftThread.getLiftUpDownCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), wrkMastLocNoLey);
+                    commands.add(command1);//灏嗗懡浠ゆ坊鍔犺繘list
+
+                    //缁欐彁鍗囨満鍒嗛厤浠诲姟
+                    liftProtocol.setTaskNo(wrkMast.getWrkNo().shortValue());//璁剧疆浠诲姟鍙�
+                    liftProtocol.setProtocolStatus(LiftProtocolStatusType.WORKING);//璁剧疆鎻愬崌鏈虹姸鎬佷负宸ヤ綔涓�
+
+                    wrkMast.setLiftNo(liftProtocol.getLiftNo().intValue());//璁剧疆鎻愬崌鏈哄彿鐢ㄤ簬閿佸畾鎻愬崌鏈洪槻姝㈣鍏朵粬浠诲姟鍗犵敤
+                    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簮搴撲綅妤煎眰
+                    int wrkMastLocNoLey = Utils.getLev(wrkMastLocNo);
+
+                    //鎻愬崌鏈哄綋鍓嶆ゼ灞�
+                    int liftLev = liftProtocol.getLev().intValue();
+
+                    //鍒ゆ柇鎻愬崌鏈烘槸鍚﹀埌浣�
+                    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
+                    }
+
+                    //杈撻�佺嚎灏嗚揣鐗╄繍杩涙潵(鏃犺揣鍙嶈浆)
+                    LiftCommand command2 = liftThread.getLiftTurnCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), 4);
+                    command2.setOperaStaNo(staProtocol.getSiteId().shortValue());//杈撻�佺嚎鎿嶄綔绔欑偣鍙�
+                    command2.setRotationDire(2);//缁欒緭閫佺嚎涓嬪彂閾炬潯杞姩淇″彿锛屽弽杞�
+                    command2.setDevpId(devpId);//杈撻�佺嚎iD
+                    command2.setStaNo((short) 104);//鍐欏叆鍑哄簱鐩爣绔�104
+                    commands.add(command2);//灏嗗懡浠ゆ坊鍔犺繘list
+
+                    //鎻愬崌鏈哄墠寰�鍑哄簱鍙o紝杈撻�佺嚎妤煎眰
+                    LiftCommand command3 = liftThread.getLiftUpDownCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), LiftLevType.TWO.lev);
+                    commands.add(command3);//灏嗗懡浠ゆ坊鍔犺繘list
+
+                    //鎻愬崌鏈哄埌杈炬寚瀹氭ゼ灞傦紝杈撻�佺嚎灏嗚揣鐗╃Щ鍑哄幓(鍙嶈浆)
+                    //杈撻�佺嚎灏嗚揣鐗╃Щ鍑哄幓
+                    LiftCommand command4 = liftThread.getLiftTurnCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), 2);
+                    command4.setOperaStaNo((short) 102);//鎿嶄綔102绔�
+                    command4.setRotationDire(2);//缁欒緭閫佺嚎涓嬪彂閾炬潯杞姩淇″彿锛屽弽杞�
+                    command4.setDevpId(devpId);
+                    commands.add(command4);//灏嗗懡浠ゆ坊鍔犺繘list
+
+                    //鎻愬崌鏈洪摼鏉℃墽琛屽畬姣曞悗锛岀粰102绔欏啓鍏ヨ祫鏂�
+                    LiftCommand command5 = liftThread.getResetCommand();
+                    command5.setDevpId(devpId);//杈撻�佺嚎iD
+                    command5.setOperaStaNo((short) 102);//鎿嶄綔102绔�
+                    command5.setStaNo((short) 104);//鍐欏叆鍑哄簱鐩爣绔�104
+                    command5.setRotationDire(0);//閾炬潯杞姩鍋滄
+                    commands.add(command5);
+
+                    //缁欐彁鍗囨満鍒嗛厤浠诲姟
+                    liftProtocol.setTaskNo(wrkMast.getWrkNo().shortValue());//璁剧疆浠诲姟鍙�
+                    liftProtocol.setProtocolStatus(LiftProtocolStatusType.WORKING);//璁剧疆鎻愬崌鏈虹姸鎬佷负宸ヤ綔涓�
+
+                    wrkMast.setLiftNo(liftProtocol.getLiftNo().intValue());//璁剧疆鎻愬崌鏈哄彿鐢ㄤ簬閿佸畾鎻愬崌鏈洪槻姝㈣鍏朵粬浠诲姟鍗犵敤
+                    wrkMast.setWrkSts(28L);//28.鎻愬崌鏈烘惉杩愪腑
                 }
 
-                //杈撻�佺嚎灏嗚揣鐗╄繍杩涙潵(鏃犺揣鍙嶈浆)
-                LiftCommand command2 = liftThread.getLiftTurnCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), 4);
-                command2.setOperaStaNo(staProtocol.getSiteId().shortValue());//杈撻�佺嚎鎿嶄綔绔欑偣鍙�
-                command2.setRotationDire(2);//缁欒緭閫佺嚎涓嬪彂閾炬潯杞姩淇″彿锛屽弽杞�
-                command2.setDevpId(devpId);//杈撻�佺嚎iD
-                command2.setStaNo((short) 104);//鍐欏叆鍑哄簱鐩爣绔�104
-                commands.add(command2);//灏嗗懡浠ゆ坊鍔犺繘list
-
-                //鎻愬崌鏈哄墠寰�鍑哄簱鍙o紝杈撻�佺嚎妤煎眰
-                LiftCommand command3 = liftThread.getLiftUpDownCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), LiftLevType.TWO.lev);
-                commands.add(command3);//灏嗗懡浠ゆ坊鍔犺繘list
-
-                //鎻愬崌鏈哄埌杈炬寚瀹氭ゼ灞傦紝杈撻�佺嚎灏嗚揣鐗╃Щ鍑哄幓(鍙嶈浆)
-                //杈撻�佺嚎灏嗚揣鐗╃Щ鍑哄幓
-                LiftCommand command4 = liftThread.getLiftTurnCommand(liftProtocol.getLiftNo(), liftProtocol.getTaskNo(), 2);
-                command4.setOperaStaNo((short) 102);//鎿嶄綔102绔�
-                command4.setRotationDire(2);//缁欒緭閫佺嚎涓嬪彂閾炬潯杞姩淇″彿锛屽弽杞�
-                command4.setDevpId(devpId);
-                commands.add(command4);//灏嗗懡浠ゆ坊鍔犺繘list
-
-                //鎻愬崌鏈洪摼鏉℃墽琛屽畬姣曞悗锛岀粰102绔欏啓鍏ヨ祫鏂�
-                LiftCommand command5 = liftThread.getResetCommand();
-                command5.setDevpId(devpId);//杈撻�佺嚎iD
-                command5.setOperaStaNo((short) 102);//鎿嶄綔102绔�
-                command5.setStaNo((short) 104);//鍐欏叆鍑哄簱鐩爣绔�104
-                command5.setRotationDire(0);//閾炬潯杞姩鍋滄
-                commands.add(command5);
-
-                //缁欐彁鍗囨満鍒嗛厤浠诲姟
-                liftProtocol.setTaskNo(wrkMast.getWrkNo().shortValue());//璁剧疆浠诲姟鍙�
-                liftProtocol.setProtocolStatus(LiftProtocolStatusType.WORKING);//璁剧疆鎻愬崌鏈虹姸鎬佷负宸ヤ綔涓�
-
-                wrkMast.setWrkSts(28L);//28.鎻愬崌鏈烘惉杩愪腑
+                //鎵�闇�鍛戒护缁勫悎瀹屾瘯锛屾洿鏂版暟鎹簱锛屾彁浜ゅ埌绾跨▼鍘诲伐浣�
+                LiftAssignCommand assignCommand = new LiftAssignCommand();
+                assignCommand.setCommands(commands);
+                assignCommand.setLiftNo(liftProtocol.getLiftNo());
+                assignCommand.setTaskNo(liftProtocol.getTaskNo());
+                if (wrkMastMapper.updateById(wrkMast) > 0) {
+                    //涓嬪彂浠诲姟
+                    MessageQueue.offer(SlaveType.Lift, liftProtocol.getLiftNo().intValue(), new Task(3, assignCommand));
+                }
             }
 
-            //鎵�闇�鍛戒护缁勫悎瀹屾瘯锛屾洿鏂版暟鎹簱锛屾彁浜ゅ埌绾跨▼鍘诲伐浣�
-            LiftAssignCommand assignCommand = new LiftAssignCommand();
-            assignCommand.setCommands(commands);
-            assignCommand.setLiftNo(liftProtocol.getLiftNo());
-            assignCommand.setTaskNo(liftProtocol.getTaskNo());
-            if (wrkMastMapper.updateById(wrkMast) > 0) {
-                //涓嬪彂浠诲姟
-                MessageQueue.offer(SlaveType.Lift, liftProtocol.getLiftNo().intValue(), new Task(3, assignCommand));
-            }
         }
     }
 
@@ -1774,6 +1880,7 @@
                             wrkMast.setWrkSts(4L);
                             //浠诲姟鍙锋竻闆�
                             liftProtocol.setTaskNo((short) 0);
+                            wrkMast.setLiftNo(null);//鎻愬崌鏈鸿В閿�
                             break;
                         case 7://7.鎻愬崌鏈鸿縼绉诲皬杞︿腑 ==> 8.鎻愬崌鏈鸿縼绉诲皬杞﹀畬鎴�
                             if (liftProtocol.getLev().intValue() != lev) {
@@ -1795,6 +1902,7 @@
                             wrkMast.setWrkSts(34L);//34.鍑哄簱瀹屾垚锛屾殏鏃跺厛鐩存帴瀹屾垚鍑哄簱宸ヤ綔妗o紝鍚庣画闇�瑕佹牴鎹緭閫佺嚎缁欏嚭鐨勭姸鎬佹潵纭畾34.鍑哄簱瀹屾垚鐘舵��
                             //浠诲姟鍙锋竻闆�
                             liftProtocol.setTaskNo((short) 0);
+                            wrkMast.setLiftNo(null);//鎻愬崌鏈鸿В閿�
                             break;
                         default:
                     }
@@ -2697,7 +2805,7 @@
                 //灏忚溅宸茬粡杈惧埌鎻愬崌鏈哄唴
 
                 //鍒ゆ柇鎻愬崌鏈烘槸鍚﹀浜庣┖闂茬姸鎬�
-                if (!liftProtocol.isIdle()) {
+                if (!liftProtocol.isIdle(wrkCharge.getWrkNo().shortValue())) {
                     continue;
                 }
 
@@ -2788,6 +2896,9 @@
             }else if (wrkCharge.getWrkSts() == 57) {//57.灏忚溅鍒拌揪鍏呯數妗�
                 //鍏呯數涓�
                 //鍒ゆ柇灏忚溅鏄惁鍏呮弧鐢甸噺锛屾弧鐢�1000鎴栫數鍘�54V浠ヤ笂
+                if (shuttleProtocol.getBatteryPower() == null || shuttleProtocol.getCurrentVoltage() == null) {
+                    continue;
+                }
                 if (shuttleProtocol.getBatteryPower() >= 1000 && shuttleProtocol.getCurrentVoltage() >= 54000) {
                     //鍏呮弧锛屾柇寮�鍏呯數
 //                    List<ShuttleCommand> commands = new ArrayList<>();

--
Gitblit v1.9.1