From 76d3fff7c27d020fd7110e4a5e84cc87e3fe7e43 Mon Sep 17 00:00:00 2001
From: lsh <lsh123456>
Date: 星期五, 03 三月 2023 15:45:32 +0800
Subject: [PATCH] #

---
 src/main/java/com/zy/asrs/service/impl/MainServiceImpl.java |  235 ++++++++++++++++++++++++++++++++++------------------------
 1 files changed, 136 insertions(+), 99 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 25e48c1..4008615 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.*;
@@ -666,7 +667,7 @@
                 // 搴撲綅绉昏浆
 //                this.locToLoc(crn, crnProtocol);
                 // 婕旂ず
-                this.steMoveDemo(crn, crnProtocol);
+//                this.steMoveDemo(crn, crnProtocol);
             }
         }
     }
@@ -1244,7 +1245,7 @@
             SteProtocol steProtocol = steThread.getSteProtocol();
             if (steProtocol == null) { continue; }
             if (!steProtocol.isIdle()) { continue; }
-            if (steProtocol.getRow() == 1) { continue; }
+//            if (steProtocol.getRow() == 1) { continue; }
             String locNo = wrkMast.getWrkSts() < 10 ? wrkMast.getLocNo() : wrkMast.getSourceLocNo();
             // 濡傛灉鍦ㄥ悓涓�涓簱浣嶇粍
             if (Utils.getGroupRow(locNo, true).equals(Utils.getGroupRow(steProtocol.getRow().intValue(), true))
@@ -1835,6 +1836,22 @@
                             }
                         }
                         // 绉诲簱 ===>> 鍫嗗灈鏈烘惉鑷崇洰鏍囧簱浣嶇粍 瀹屾垚
+                    } else if (wrkMast.getWrkSts() == 16) {
+                        // 16.鍚婅溅鍑哄簱涓� ==> 17.鍑哄簱瀹屾垚
+                        wrkMast.setWrkSts(17L);
+                        Date now = new Date();
+                        wrkMast.setCrnEndTime(now);
+                        wrkMast.setModiTime(now);
+                        LocMast locMast = locMastService.selectById(wrkMast.getSourceLocNo());
+                        Integer outCrnNo = locMastService.getOutCrnNo(locMast);
+                        wrkMast.setCrnNo(outCrnNo);
+                        // 淇敼鎴愬姛鍚庡浣嶅爢鍨涙満
+                        if (wrkMastMapper.updateById(wrkMast) > 0) {
+                            // 鍫嗗灈鏈哄浣�
+                            crnThread.setResetFlag(true);
+                        } else {
+                            News.error("淇敼宸ヤ綔妗g姸鎬� 16.鍚婅溅鍑哄簱涓� ==> 17.鍑哄簱瀹屾垚 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkMast.getWrkNo());
+                        }
                     }
                 }
             }
@@ -1879,15 +1896,17 @@
                                 } else {
                                     steThread.setResetFlag(true);
                                 }
-                            } else if (wrkCharge.getWrkSts() == 29) {
-                                // 29.寮�濮嬪厖鐢� ===>> 30.瀹屾垚鍏呯數
-                                wrkCharge.setWrkSts(30L);
-                                if (!wrkChargeService.updateById(wrkCharge)) {
-                                    News.error("淇敼鍏呯數浠诲姟鐘舵�� 29.寮�濮嬪厖鐢� ===>> 30.瀹屾垚鍏呯數 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkCharge.getWrkNo());
-                                } else {
-                                    steThread.setResetFlag(true);
-                                }
-                            } else if (wrkCharge.getWrkSts() == 32) {
+                            }
+//                            else if (wrkCharge.getWrkSts() == 29) {
+//                                // 29.寮�濮嬪厖鐢� ===>> 30.瀹屾垚鍏呯數
+//                                wrkCharge.setWrkSts(30L);
+//                                if (!wrkChargeService.updateById(wrkCharge)) {
+//                                    News.error("淇敼鍏呯數浠诲姟鐘舵�� 29.寮�濮嬪厖鐢� ===>> 30.瀹屾垚鍏呯數 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkCharge.getWrkNo());
+//                                } else {
+//                                    steThread.setResetFlag(true);
+//                                }
+//                            }
+                            else if (wrkCharge.getWrkSts() == 32) {
                                 // 32.灏忚溅璧拌 ===>> 33.灏忚溅寰呮惉
                                 wrkCharge.setWrkSts(33L);
                                 if (!wrkChargeService.updateById(wrkCharge)) {
@@ -2486,7 +2505,7 @@
                     SteChargeType steCharge = null;
                     do {
                         String locNo;
-                        if (!devpThread.charge0) {
+                        if (devpThread.charge0) {
                             SteChargeType first = SteChargeType.FIRST;
                             locNo = first.locNo;
                             if (basSteService.hasCarOfLocNo(locNo) == null
@@ -2540,11 +2559,11 @@
                     if (steProtocol.getRow().intValue() == Utils.getRow(chargeLocNo)
                             && steProtocol.getBay().intValue() == Utils.getBay(chargeLocNo)
                             && steProtocol.getLev().intValue() == Utils.getLev(chargeLocNo)) {
-                        // 淇敼宸ヤ綔妗g姸鎬� 21.鍑嗗鍏呯數 => 28.鍏呯數灏辩华
-                        wrkCharge.setWrkSts(28L);
+                        // 淇敼宸ヤ綔妗g姸鎬� 21.鍑嗗鍏呯數 => 24.灏忚溅鍒拌揪
+                        wrkCharge.setWrkSts(24L);
                         wrkCharge.setModiTime(new Date());
                         if (!wrkChargeService.updateById(wrkCharge)) {
-                            News.error("淇敼鍏呯數浠诲姟鐘舵�� 21.鍑嗗鍏呯數 => 28.鍏呯數灏辩华 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkCharge.getWrkNo());
+                            News.error("淇敼鍏呯數浠诲姟鐘舵�� 21.鍑嗗鍏呯數 => 24.灏忚溅鍒拌揪 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkCharge.getWrkNo());
                         }
                     } else {
                         this.letCarBeWaiting(wrkCharge, ste.getId());
@@ -2582,6 +2601,7 @@
             return;
         }
         if (steProtocol.getCharge() > Float.parseFloat(basSte.getChargeLine())) {
+            MessageQueue.offer(SlaveType.Devp, 1, new Task(3, 999));//鍏呯數鏍囪
             wrkCharge.setWrkSts(30L);
             wrkChargeMapper.updateById(wrkCharge);
             return;
@@ -2600,49 +2620,39 @@
                     return;
                 }
 
+                LocMast locMast = locMastService.selectById(basSte.getIdleLoc());
+
                 // 鎼皬杞﹁嚦灏忚溅璧板悜閫氶亾
-                List<String> channel = slaveProperties.getChannel();
-                for (String channelLocNo : channel) {
-                    Integer otherSte = existOtherSte(channelLocNo, wrkCharge.getSteNo());
-                    if (null != otherSte) {
-                        News.warn("{}鍙峰皬杞︾Щ鍏}搴撲綅缁勫け璐ワ紝鍘熷洜锛氬瓨鍦▄}鍙风┛姊溅锛�", wrkCharge.getSteNo(), channelLocNo, otherSte);
+                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(locMast.getLocNo(), true).shortValue());     // 鐩爣搴撲綅鎺�
+                    crnCommand.setDestinationPosY(locMast.getBay1().shortValue());     // 鐩爣搴撲綅鍒�
+                    crnCommand.setDestinationPosZ(locMast.getLev1().shortValue());     // 鐩爣搴撲綅灞�
+                    if (!MessageQueue.offer(SlaveType.Crn, wrkCharge.getCrnNo(), new Task(2, crnCommand))) {
+                        News.error("鍫嗗灈鏈哄懡浠や笅鍙戝け璐ワ紝鍫嗗灈鏈哄彿={}锛屼换鍔℃暟鎹�={}", wrkCharge.getCrnNo(), JSON.toJSON(crnCommand));
                     } else {
-                        LocMast channelLoc = locMastService.selectById(channelLocNo);
-
-                        CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn, wrkCharge.getCrnNo());
-                        CrnProtocol crnProtocol = crnThread.getCrnProtocol();
-                        if (crnProtocol == null) { continue; }
-                        // 鍙湁褰撳爢鍨涙満绌洪棽 骞朵笖 鏃犱换鍔℃椂鎵嶇户缁墽琛�
-                        if (crnProtocol.getStatusType() == CrnStatusType.IDLE && crnProtocol.getTaskNo() == 0 && crnProtocol.getModeType() == CrnModeType.AUTO) {
-                            // 鍫嗗灈鏈哄懡浠や笅鍙戝尯 --------------------------------------------------------------------------
-                            CrnCommand crnCommand = new CrnCommand();
-                            crnCommand.setCrnNo(wrkCharge.getCrnNo()); // 鍫嗗灈鏈虹紪鍙�
-                            crnCommand.setTaskNo(wrkCharge.getWrkNo().shortValue()); // 宸ヤ綔鍙�
-                            crnCommand.setAckFinish((short) 0);  // 浠诲姟瀹屾垚纭浣�
-                            crnCommand.setTaskMode(CrnTaskModeType.STE_MOVE); // 浠诲姟妯″紡:  搴撲綅绉昏浆
-                            crnCommand.setSourcePosX(Utils.getGroupRow(steProtocol.getRow().intValue(), true).shortValue());     // 婧愬簱浣嶆帓
-                            crnCommand.setSourcePosY(steProtocol.getBay());     // 婧愬簱浣嶅垪
-                            crnCommand.setSourcePosZ(steProtocol.getLev());     // 婧愬簱浣嶅眰
-                            crnCommand.setDestinationPosX(Utils.getGroupRow(channelLoc.getLocNo(), true).shortValue());     // 鐩爣搴撲綅鎺�
-                            crnCommand.setDestinationPosY(channelLoc.getBay1().shortValue());     // 鐩爣搴撲綅鍒�
-                            crnCommand.setDestinationPosZ(channelLoc.getLev1().shortValue());     // 鐩爣搴撲綅灞�
-                            if (!MessageQueue.offer(SlaveType.Crn, wrkCharge.getCrnNo(), new Task(2, crnCommand))) {
-                                News.error("鍫嗗灈鏈哄懡浠や笅鍙戝け璐ワ紝鍫嗗灈鏈哄彿={}锛屼换鍔℃暟鎹�={}", wrkCharge.getCrnNo(), JSON.toJSON(crnCommand));
-                            } else {
-                                // 淇敼绌挎杞﹁繍琛屼腑鎺掑垪灞�
-                                steThread.modifyPos(Utils.getGroupRow(channelLoc.getLocNo(), true), channelLoc.getBay1(), channelLoc.getLev1());
-                                // 淇敼宸ヤ綔妗g姸鎬� 22.灏忚溅寰呮惉 => 23.鍚婅溅鎼繍
-                                Date now = new Date();
-                                wrkCharge.setWrkSts(23L);
-                                wrkCharge.setCrnStrTime(now);
-                                wrkCharge.setModiTime(now);
-                                if (!wrkChargeService.updateById(wrkCharge)) {
-                                    News.error("淇敼宸ヤ綔妗g姸鎬� 22.灏忚溅寰呮惉 => 23.鍚婅溅鎼繍 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkCharge.getWrkNo());
-                                }
-                            }
-                            break;
+                        // 淇敼绌挎杞﹁繍琛屼腑鎺掑垪灞�
+                        steThread.modifyPos(Utils.getGroupRow(locMast.getLocNo(), true), locMast.getBay1(), locMast.getLev1());
+                        // 淇敼宸ヤ綔妗g姸鎬� 22.灏忚溅寰呮惉 => 23.鍚婅溅鎼繍
+                        Date now = new Date();
+                        wrkCharge.setWrkSts(23L);
+                        wrkCharge.setCrnStrTime(now);
+                        wrkCharge.setModiTime(now);
+                        if (!wrkChargeService.updateById(wrkCharge)) {
+                            News.error("淇敼宸ヤ綔妗g姸鎬� 22.灏忚溅寰呮惉 => 23.鍚婅溅鎼繍 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkCharge.getWrkNo());
                         }
-
                     }
                 }
 
@@ -2654,7 +2664,7 @@
                     SteCommand steCommand = new SteCommand();
                     steCommand.setSteNo(wrkCharge.getSteNo()); // 绌挎杞︾紪鍙�
                     steCommand.setTaskNo(wrkCharge.getWrkNo()); // 宸ヤ綔鍙�
-                    steCommand.setTaskMode(SteTaskModeType.GO_ORIGIN);  // 鍘诲彸绔�
+                    steCommand.setTaskMode(SteTaskModeType.BACK_ORIGIN);  // 鍘诲彸绔�
 
                     steCommand.setRow(Utils.getGroupRow(steProtocol.getRow().intValue(), false).shortValue());
                     steCommand.setBay(steProtocol.getBay());
@@ -2673,49 +2683,6 @@
                     }
                 }
             } else if (wrkCharge.getWrkSts() == 26) {
-                // 鍥哄畾鍫嗗灈鏈�
-                int crnNo = 1;
-                // 鍏ュ嚭搴撲换鍔′紭鍏�
-                if (null != wrkMastMapper.selectWorkingByCrn(crnNo)) {
-                    return;
-                }
-
-                // 鍏呯數浣�
-                LocMast chargeLoc = locMastService.selectById(wrkCharge.getLocNo());
-
-                CrnThread crnThread = (CrnThread) SlaveConnection.get(SlaveType.Crn, crnNo);
-                CrnProtocol crnProtocol = crnThread.getCrnProtocol();
-                if (crnProtocol == null) { return; }
-                // 鍙湁褰撳爢鍨涙満绌洪棽 骞朵笖 鏃犱换鍔℃椂鎵嶇户缁墽琛�
-                if (crnProtocol.getStatusType() == CrnStatusType.IDLE && crnProtocol.getTaskNo() == 0 && crnProtocol.getModeType() == CrnModeType.AUTO) {
-                    // 鍫嗗灈鏈哄懡浠や笅鍙戝尯 --------------------------------------------------------------------------
-                    CrnCommand crnCommand = new CrnCommand();
-                    crnCommand.setCrnNo(crnNo); // 鍫嗗灈鏈虹紪鍙�
-                    crnCommand.setTaskNo(wrkCharge.getWrkNo().shortValue()); // 宸ヤ綔鍙�
-                    crnCommand.setAckFinish((short) 0);  // 浠诲姟瀹屾垚纭浣�
-                    crnCommand.setTaskMode(CrnTaskModeType.STE_MOVE); // 浠诲姟妯″紡:  搴撲綅绉昏浆
-                    crnCommand.setSourcePosX(Utils.getGroupRow(steProtocol.getRow().intValue(), false).shortValue());     // 婧愬簱浣嶆帓
-                    crnCommand.setSourcePosY(steProtocol.getBay());     // 婧愬簱浣嶅垪
-                    crnCommand.setSourcePosZ(steProtocol.getLev());     // 婧愬簱浣嶅眰
-                    crnCommand.setDestinationPosX(chargeLoc.getRow1().shortValue());     // 鐩爣搴撲綅鎺�
-                    crnCommand.setDestinationPosY(chargeLoc.getBay1().shortValue());     // 鐩爣搴撲綅鍒�
-                    crnCommand.setDestinationPosZ(chargeLoc.getLev1().shortValue());     // 鐩爣搴撲綅灞�
-                    if (!MessageQueue.offer(SlaveType.Crn, crnNo, new Task(2, crnCommand))) {
-                        News.error("鍫嗗灈鏈哄懡浠や笅鍙戝け璐ワ紝鍫嗗灈鏈哄彿={}锛屼换鍔℃暟鎹�={}", crnNo, JSON.toJSON(crnCommand));
-                    } else {
-                        // 淇敼绌挎杞﹁繍琛屼腑鎺掑垪灞�
-                        steThread.modifyPos(chargeLoc.getRow1(), chargeLoc.getBay1(), chargeLoc.getLev1());
-                        // 淇敼宸ヤ綔妗g姸鎬� 26.绛夊緟鍏呯數 => 27.鏀捐嚦鍏呯數浣�
-                        Date now = new Date();
-                        wrkCharge.setWrkSts(27L);
-                        wrkCharge.setCrnStrTime(now);
-                        wrkCharge.setModiTime(now);
-                        if (!wrkChargeService.updateById(wrkCharge)) {
-                            News.error("淇敼宸ヤ綔妗g姸鎬� 26.绛夊緟鍏呯數 => 27.鏀捐嚦鍏呯數浣� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkCharge.getWrkNo());
-                        }
-                    }
-                }
-            } else if (wrkCharge.getWrkSts() == 28L) {
                 // 绌挎杞︿笅鍙戝厖鐢典换鍔�
                 SteCommand steCommand = new SteCommand();
                 steCommand.setSteNo(wrkCharge.getSteNo()); // 绌挎杞︾紪鍙�
@@ -2728,6 +2695,19 @@
                     wrkCharge.setWrkSts(29L);
                     if (!wrkChargeService.updateById(wrkCharge)) {
                         News.error("淇敼鍏呯數浠诲姟鐘舵�� 28.鍏呯數灏辩华 ===>> 29.寮�濮嬪厖鐢� 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkCharge.getWrkNo());
+                    }
+                }
+            } else if (wrkCharge.getWrkSts() == 29) {
+                Float idle2 = steProtocol.isIdle2();
+                String chargeLine = SpringUtils.getBean(BasSteService.class).selectById(1).getChargeLine();
+                if (idle2<(Float.parseFloat(chargeLine)+2)){
+                    MessageQueue.offer(SlaveType.Devp, 1, new Task(3, 666));//鍏呯數鏍囪
+                }else if (idle2 > 70f){
+                    MessageQueue.offer(SlaveType.Devp, 1, new Task(3, 999));//鍏呯數鏍囪
+                    // 29.寮�濮嬪厖鐢� ===>> 30.瀹屾垚鍏呯數
+                    wrkCharge.setWrkSts(30L);
+                    if (!wrkChargeService.updateById(wrkCharge)) {
+                        News.error("淇敼鍏呯數浠诲姟鐘舵�� 29.寮�濮嬪厖鐢� ===>> 30.瀹屾垚鍏呯數 澶辫触锛侊紒锛屽伐浣滃彿={}", wrkCharge.getWrkNo());
                     }
                 }
             }
@@ -3254,6 +3234,63 @@
         }
 
     }
+    /**
+     * 鍑哄叆搴撴ā寮忓垏鎹�
+     */
+    public synchronized void outAndIn() {
+        try {
+            // 鏍规嵁杈撻�佺嚎plc閬嶅巻
+            for (DevpSlave devp : slaveProperties.getDevp()) {
+                for (DevpSlave.Sta inSta : devp.getInSta()) {
+                    Thread.sleep(500);
+                    boolean a=true,b=true;
+                    List<WrkMast> wrkMasts = wrkMastMapper.selectAll(inSta.getStaNo());
+                    if (Cools.isEmpty(wrkMasts)){
+                        b=false;
+                    }else {
+                        for (WrkMast wrkMast:wrkMasts){
+                            if (wrkMast.getSourceStaNo()!=wrkMast.getStaNo()){
+                                a=false;
+                                break;
+                            }
+                        }
+                    }
+                    switch (inSta.getStaNo()) {
+                        case 102://1F
+                            if (a && b){
+                                MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(3, 11));
+                            }else if (b){
+                                MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(3, 12));
+                            }else {
+                                MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(3, 10));
+                            }
+                            break;
+                        case 202://2F
+                            if (a && b){
+                                MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(3, 21));
+                            }else if (b){
+                                MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(3, 22));
+                            }else {
+                                MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(3, 20));
+                            }
+                            break;
+                        case 302://3F
+                            if (a && b){
+                                MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(3, 31));
+                            }else if (b){
+                                MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(3, 32));
+                            }else {
+                                MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(3, 30));
+                            }
+                            break;
+                    }
+                }
+            }
+
+        } catch (Exception e) {
+            e.printStackTrace();
+        }
+    }
 
 
 }

--
Gitblit v1.9.1