From 32bf433492f540b1392c19757124ebb91d0e74bd Mon Sep 17 00:00:00 2001
From: Junjie <fallin.jie@qq.com>
Date: 星期三, 29 三月 2023 15:55:01 +0800
Subject: [PATCH] 四向车入库分配任务逻辑

---
 src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java |  220 ++++++++++++++++++++++++++++++++++++++++++++++--------
 1 files changed, 186 insertions(+), 34 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 f0846ce..e3d8031 100644
--- a/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java
+++ b/src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java
@@ -609,45 +609,191 @@
      * 鍏ュ嚭搴�  ===>>  鍥涘悜绌挎杞﹀叆鍑哄簱浣滀笟涓嬪彂
      */
     public synchronized void shuttleIoExecute() {
-        for (ShuttleSlave shuttle : slaveProperties.getShuttle()) {
-            //鑾峰彇鍥涘悜绌挎杞︿俊鎭�
-            ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttle.getId());
-            ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
-            if (shuttleProtocol == null) {
-                continue;
-            }
+        // 鏍规嵁杈撻�佺嚎plc閬嶅巻
+        for (DevpSlave devp : slaveProperties.getDevp()) {
+            // 閬嶅巻鍏ュ簱绔�
+            for (DevpSlave.StaRack rackInStn : devp.getRackInStn()) {
+                // 鑾峰彇鍏ュ簱绔欎俊鎭�
+                DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, devp.getId());
 
-            // 鍙湁褰撳洓鍚戠┛姊溅绌洪棽 骞朵笖鏃犱换鍔℃椂鎵嶇户缁墽琛�
-            if (shuttleProtocol.getBusyStatusType() == ShuttleStatusType.IDLE && shuttleProtocol.getTaskNo() == 0) {
-                //鍏ュ嚭搴撻�昏緫
-                for (WrkMast wrkSts : wrkMastMapper.selectList(new EntityWrapper<WrkMast>().eq("wrk_sts", 2))) {
-                    //鍒嗛厤浠诲姟鍙�
-                    shuttleProtocol.setTaskNo(wrkSts.getWrkNo().shortValue());
-                    //鍒嗛厤婧愬簱浣�
-                    shuttleProtocol.setSourceLocNo(wrkSts.getSourceLocNo());
-                    //鍒嗛厤鐩爣搴撲綅
-                    shuttleProtocol.setLocNo(wrkSts.getLocNo());
+                StaProtocol staProtocol = devpThread.getStation().get(rackInStn.getStaNo());
+                StaProtocol staProtocol105 = devpThread.getStation().get(105);
+                staProtocol105.setWorkNo((short) 752);
+                staProtocol105.setStaNo((short) 100);
 
+                StaProtocol staProtocol106 = devpThread.getStation().get(106);
+                staProtocol106.setWorkNo((short) 753);
+                staProtocol106.setStaNo((short) 100);
 
-                    ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
-                    //鍥涘悜绌挎杞﹀彿
-                    assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());
-                    //浠诲姟鍙�
-                    assignCommand.setTaskNo(wrkSts.getWrkNo().shortValue());
-                    //鍏ュ嚭搴撴ā寮�
-                    assignCommand.setTaskMode((short) 0);
-                    //婧愬簱浣�
-                    assignCommand.setSourceLocNo(wrkSts.getSourceLocNo());
-                    //鐩爣搴撲綅
-                    assignCommand.setDistLocNo(wrkSts.getLocNo());
+                if (staProtocol == null) {
+                    continue;
+                } else {
+                    staProtocol = staProtocol.clone();
+                }
+                Short workNo = staProtocol.getWorkNo();
 
-                    //涓嬪彂浠诲姟
-                    MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
+                // 鍒ゆ柇鏄惁婊¤冻鍏ュ簱鏉′欢
+                if (true || staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.isInEnable()) {
+                    WrkMast wrkMast = wrkMastMapper.selectRackInStep48(workNo, staProtocol.getSiteId());
+                    if (wrkMast != null) {
+                        if (wrkMast.getWrkSts() == 4) {
+                            //瀵绘壘鏈�杩戜笖绌洪棽鐨勫洓鍚戠┛姊溅
+                            HashMap<String, Object> searchIdleShuttle = this.searchIdleShuttle(wrkMast);
+                            ShuttleThread shuttleThread = (ShuttleThread) searchIdleShuttle.get("result");
+                            if (shuttleThread == null) {
+                                continue;
+                            }
+
+                            ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
+                            wrkMast.setShuttleNo(shuttleProtocol.getShuttleNo().intValue());//缁欏伐浣滄。鍒嗛厤鍥涘悜绌挎杞﹀彿
+
+                            //鍒嗛厤浠诲姟鍙�
+                            shuttleProtocol.setTaskNo(wrkMast.getWrkNo().shortValue());
+                            //鍒嗛厤婧愬簱浣�
+                            shuttleProtocol.setSourceLocNo(wrkMast.getSourceLocNo());
+
+                            ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
+                            //鍥涘悜绌挎杞﹀彿
+                            assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());
+                            //浠诲姟鍙�
+                            assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue());
+                            //鍏ュ嚭搴撴ā寮�
+                            assignCommand.setTaskMode(ShuttleTaskModeType.PAK_IN.id.shortValue());
+                            //婧愬簱浣�(灏忚溅褰撳墠浣嶇疆)
+                            Short currentCode = shuttleProtocol.getCurrentCode();
+                            LocMast currentLocMast = locMastService.queryByQrCode(currentCode.toString());
+                            assignCommand.setSourceLocNo(currentLocMast.getLocNo());
+
+                            if (Boolean.parseBoolean(searchIdleShuttle.get("sameLay").toString())) {
+                                //鍚屼竴灞�
+                                //鍒嗛厤鐩爣搴撲綅
+                                shuttleProtocol.setLocNo(wrkMast.getLocNo());
+                                //鐩爣搴撲綅
+                                assignCommand.setDistLocNo(wrkMast.getLocNo());
+                                wrkMast.setWrkSts(9L);//灏忚溅鍏ュ簱涓�
+                            }else {
+                                //涓嶅悓灞傦紝灏嗙洰鏍囧簱浣嶅垎閰嶆垚鎻愬崌鏈哄簱浣嶅彿
+                                //鍒嗛厤鐩爣搴撲綅
+                                shuttleProtocol.setLocNo("1800201");
+                                //鐩爣搴撲綅
+                                assignCommand.setDistLocNo("1800201");
+                                wrkMast.setWrkSts(5L);//灏忚溅杩佺Щ鐘舵��
+                            }
+
+                            if (wrkMastMapper.updateById(wrkMast) > 0) {
+                                //涓嬪彂浠诲姟
+                                MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
+                            }
+                        }else {
+                            //鐘舵��8锛屽洓鍚戠┛姊溅宸插湪鎻愬崌鏈哄彛锛岀瓑寰呭懡浠よ繘琛屽叆搴撴惉杩愬姩浣�
+                            Integer shuttleNo = wrkMast.getShuttleNo();//鍥涘悜绌挎杞﹀彿
+                            ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttleNo);
+                            if (shuttleThread == null) {
+                                continue;
+                            }
+                            ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
+
+                            //鍒嗛厤鐩爣搴撲綅
+                            shuttleProtocol.setLocNo(wrkMast.getLocNo());
+
+                            ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
+                            //鍥涘悜绌挎杞﹀彿
+                            assignCommand.setShuttleNo(shuttleNo.shortValue());
+                            //浠诲姟鍙�
+                            assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue());
+                            //鍏ュ嚭搴撴ā寮�
+                            assignCommand.setTaskMode(ShuttleTaskModeType.PAK_IN.id.shortValue());
+                            //婧愬簱浣�(灏忚溅褰撳墠浣嶇疆)
+                            Short currentCode = shuttleProtocol.getCurrentCode();
+                            LocMast currentLocMast = locMastService.queryByQrCode(currentCode.toString());
+                            assignCommand.setSourceLocNo(currentLocMast.getLocNo());
+                            //鐩爣搴撲綅
+                            assignCommand.setDistLocNo(wrkMast.getLocNo());
+                            wrkMast.setWrkSts(9L);//灏忚溅鍏ュ簱涓�
+                            if (wrkMastMapper.updateById(wrkMast) > 0) {
+                                //涓嬪彂浠诲姟
+                                MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
+                            }
+                        }
+
+                    }
                 }
 
             }
         }
 
+    }
+
+    /**
+     * 鎼滅储绌洪棽涓旀渶杩戠殑鍥涘悜绌挎杞�
+     */
+    public HashMap<String,Object> searchIdleShuttle(WrkMast wrkMast) {
+        HashMap<String, Object> map = new HashMap<>();
+        String locNo = wrkMast.getWrkSts() < 10 ? wrkMast.getLocNo() : wrkMast.getSourceLocNo();//搴撲綅鍙�
+        LocMast locMast = locMastService.queryByLoc(locNo);//鎵惧埌搴撲綅璁板綍
+        String lay = locNo.substring(locNo.length() - 2, locNo.length());//褰撳墠宸ヤ綔妗e簱浣嶅眰楂�
+        ShuttleThread recentShuttle = null;//褰撳墠璺濈鏈�杩戠殑鍥涘悜绌挎杞︾嚎绋�
+
+        for (ShuttleSlave shuttle : slaveProperties.getShuttle()) {
+            //鑾峰彇鍥涘悜绌挎杞︾嚎绋�
+            ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttle.getId());
+            ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
+            if (shuttleProtocol == null) {
+                continue;
+            }
+            if (!shuttleProtocol.isIdle()) {
+                continue;
+            }
+
+            Short currentCode = shuttleProtocol.getCurrentCode();//鍥涘悜绌挎杞﹀綋鍓嶄綅缃簩缁寸爜
+            LocMast shuttleLocMast = locMastService.queryByQrCode(currentCode.toString());//鎵惧埌浜岀淮鐮佸搴旂殑搴撲綅璁板綍
+            String shuttleLocNo = shuttleLocMast.getLocNo();//浜岀淮鐮佸搴斿簱浣嶅彿
+            String shuttleLocNoLay = shuttleLocNo.substring(shuttleLocNo.length() - 2, shuttleLocNo.length());//搴撲綅鍙峰搴斿眰楂�
+            if (lay.equals(shuttleLocNoLay)) {
+                //褰撳墠鍥涘悜绌挎杞﹀拰宸ヤ綔妗d换鍔″湪鍚屼竴灞傦紝鍒欒皟閰嶈杞﹁締
+                map.put("sameLay", true);//鍚屼竴灞�
+                map.put("result", shuttleThread);
+                return map;
+            }
+
+            //鏇存柊褰撳墠鏈�杩戠殑鍥涘悜绌挎杞�
+            if (recentShuttle == null) {
+                recentShuttle = shuttleThread;
+            }else {
+                ShuttleProtocol recentShuttleProtocol = recentShuttle.getShuttleProtocol();//鐩墠鏈�杩戠┛姊溅
+                Short recentShuttleCurrentCode = recentShuttleProtocol.getCurrentCode();//鐩墠鏈�杩戠┛姊溅浣嶇疆浜岀淮鐮�
+                LocMast recentShuttleLocMast = locMastService.queryByQrCode(recentShuttleCurrentCode.toString());//鎵惧埌浜岀淮鐮佸搴旂殑搴撲綅璁板綍
+                String recentShuttleLocNo = recentShuttleLocMast.getLocNo();//浜岀淮鐮佸搴斿簱浣嶅彿
+                String recentShuttleLocNoLay = recentShuttleLocNo.substring(recentShuttleLocNo.length() - 2, recentShuttleLocNo.length());//搴撲綅鍙峰搴斿眰楂�
+
+                int recentShuttleLocNoLayInt = Integer.parseInt(recentShuttleLocNoLay);
+                int layInt = Integer.parseInt(lay);
+                int shuttleLocNoLayInt = Integer.parseInt(shuttleLocNoLay);
+                int i = Math.abs(layInt - recentShuttleLocNoLayInt);//宸ヤ綔妗fゼ灞傚噺鏈�杩戠┛姊溅妤煎眰锛屽彇缁濆鍊�
+                int j = Math.abs(layInt - shuttleLocNoLayInt);//宸ヤ綔妗fゼ灞傚噺褰撳墠绌挎杞︽ゼ灞傦紝鍙栫粷瀵瑰��
+                if (i < j) {
+                    //鏇存柊鏈�杩戠┛姊溅
+                    recentShuttle = shuttleThread;
+                } else if (i == j) {
+                    //妤煎眰鐩稿悓鎯呭喌
+                    //鎵捐窛绂诲嚭搴撶偣鏈�杩戠殑杞�
+
+                    //褰撳墠鏈�杩戝洓鍚戠┛姊溅鍒版彁鍗囨満璺緞
+                    List<NavigateNode> recentShuttlePath = NavigateUtils.calc(recentShuttleLocNo, "1800201", ShuttleTaskModeType.PAK_IN.id);
+                    //褰撳墠妤煎眰鍥涘悜绌挎杞﹀埌鎻愬崌鏈鸿矾寰�
+                    List<NavigateNode> shuttlePath = NavigateUtils.calc(shuttleLocNo, "1800201", ShuttleTaskModeType.PAK_IN.id);
+                    //鍒ゆ柇鍝竴涓矾寰勬渶鐭�
+                    if (shuttlePath.size() < recentShuttlePath.size()) {
+                        //濡傛灉褰撳墠妤煎眰鐨勮溅璺緞鏇村皬锛屽垯鏇存柊鏈�杩戠┛姊溅
+                        recentShuttle = shuttleThread;
+                    }
+                }
+            }
+        }
+
+        map.put("sameLay", false);//涓嶅悓灞�
+        map.put("result", recentShuttle);
+        return map;
     }
 
     /**
@@ -665,17 +811,23 @@
             //鍥涘悜绌挎杞︾姸鎬佷负绛夊緟纭
             if (shuttleProtocol.getProtocolStatus() == ShuttleProtocolStatusType.WAITING.id && shuttleProtocol.getTaskNo() != 0) {
                 //灏嗕换鍔℃。鏍囪涓哄畬鎴�
-                WrkMast wrkMast = wrkMastMapper.selectByWorkNo(shuttleProtocol.getTaskNo().intValue());
+                WrkMast wrkMast = wrkMastMapper.selectByWorkNo9(shuttleProtocol.getTaskNo().intValue());
                 if (wrkMast != null) {
-                    wrkMast.setWrkSts(8L);
+                    wrkMast.setWrkSts(14L);
                     if (wrkMastMapper.updateById(wrkMast) > 0) {
                         //璁剧疆鍥涘悜绌挎杞︿负绌洪棽鐘舵��
                         shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.IDLE);
                         //浠诲姟鍙锋竻闆�
                         shuttleProtocol.setTaskNo((short) 0);
-                        News.error("鍥涘悜绌挎杞﹀浜庣瓑寰呯‘璁や笖浠诲姟瀹屾垚鐘舵��,澶嶄綅銆傚爢鍨涙満鍙�={}锛屽伐浣滃彿={}", shuttleProtocol.getShuttleNo(), shuttleProtocol.getTaskNo());
+                        //婧愬簱浣嶆竻闆�
+                        shuttleProtocol.setSourceLocNo(null);
+                        //鐩爣搴撲綅娓呴浂
+                        shuttleProtocol.setLocNo(null);
+                        //鏍囪澶嶄綅
+                        shuttleProtocol.setPakMk(true);
+                        News.error("鍥涘悜绌挎杞﹀凡纭涓斾换鍔″畬鎴愮姸鎬�,澶嶄綅銆傚爢鍨涙満鍙�={}", shuttleProtocol.getShuttleNo());
                     } else {
-                        News.error("鍥涘悜绌挎杞﹀浜庣瓑寰呯‘璁や笖浠诲姟瀹屾垚鐘舵��,澶嶄綅澶辫触锛屼絾鏈壘鍒板伐浣滄。銆傚洓鍚戠┛姊溅鍙�={}锛屽伐浣滃彿={}", shuttleProtocol.getShuttleNo(), shuttleProtocol.getTaskNo());
+                        News.error("鍥涘悜绌挎杞﹀凡纭涓斾换鍔″畬鎴愮姸鎬�,澶嶄綅澶辫触锛屼絾鏈壘鍒板伐浣滄。銆傚洓鍚戠┛姊溅鍙�={}锛屽伐浣滃彿={}", shuttleProtocol.getShuttleNo(), shuttleProtocol.getTaskNo());
                     }
                 }
 

--
Gitblit v1.9.1