From 1f290b785adec6e9409adf2c9241bdd01eacf0ee Mon Sep 17 00:00:00 2001
From: Junjie <fallin.jie@qq.com>
Date: 星期二, 25 七月 2023 09:02:58 +0800
Subject: [PATCH] 捡料

---
 src/main/java/com/zy/core/thread/LiftThread.java |  168 +++++++++++++++++++++++++++++++++++++++++++++----------
 1 files changed, 136 insertions(+), 32 deletions(-)

diff --git a/src/main/java/com/zy/core/thread/LiftThread.java b/src/main/java/com/zy/core/thread/LiftThread.java
index 2504792..d2dfb3a 100644
--- a/src/main/java/com/zy/core/thread/LiftThread.java
+++ b/src/main/java/com/zy/core/thread/LiftThread.java
@@ -11,8 +11,11 @@
 import com.core.exception.CoolException;
 import com.zy.asrs.entity.BasLift;
 import com.zy.asrs.entity.BasLiftOpt;
+import com.zy.asrs.entity.WrkMast;
+import com.zy.asrs.mapper.WrkMastMapper;
 import com.zy.asrs.service.BasLiftOptService;
 import com.zy.asrs.service.BasLiftService;
+import com.zy.asrs.utils.Utils;
 import com.zy.common.utils.CommonUtils;
 import com.zy.common.utils.RedisUtil;
 import com.zy.core.DevpThread;
@@ -65,7 +68,7 @@
                 switch (step) {
                     // 璇绘暟鎹�
                     case 1:
-                        readStatus();
+                        read();
                         break;
                     // 鍐欏叆鏁版嵁
                     case 2:
@@ -109,6 +112,28 @@
     @Override
     public void close() {
         modbusTcpNet.ConnectClose();
+    }
+
+    private void read() {
+        try {
+            readStatus();
+
+            //鎻愬崌鏈哄浜庤繍琛岀姸鎬侊紝灏嗘爣璁扮疆涓簍rue
+            if (liftProtocol.getRunning()) {
+                liftProtocol.setPakMk(true);
+            }
+
+            //鎻愬崌鏈哄浜庢湭杩愯銆佸氨缁�佹爣璁皌rue銆佹湁浠诲姟鍙�
+            if (!liftProtocol.getRunning()
+                    && liftProtocol.getPakMk()
+                    && liftProtocol.getTaskNo() != 0) {
+                //杩樻湁鏈畬鎴愮殑鍛戒护
+                executeWork(liftProtocol.getTaskNo());
+            }
+        } catch (Exception e) {
+            OutputQueue.LIFT.offer(MessageFormat.format("銆恵0}銆戞彁鍗囨満plc鐘舵�佷俊鎭け璐� ===>> [id:{1}] [ip:{2}] [port:{3}]", DateUtils.convert(new Date()), slave.getId(), slave.getIp(), slave.getPort()));
+            initLift();
+        }
     }
 
     private void readStatus() {
@@ -175,19 +200,6 @@
 
                 ///璇诲彇鎻愬崌鏈虹姸鎬�-end
 
-                //鎻愬崌鏈哄浜庤繍琛岀姸鎬侊紝灏嗘爣璁扮疆涓簍rue
-                if (liftProtocol.getRunning()) {
-                    liftProtocol.setPakMk(true);
-                }
-
-                //鎻愬崌鏈哄浜庢湭杩愯銆佸氨缁�佹爣璁皌rue銆佹湁浠诲姟鍙�
-                if (!liftProtocol.getRunning()
-                        && liftProtocol.getPakMk()
-                        && liftProtocol.getTaskNo() != 0) {
-                    //杩樻湁鏈畬鎴愮殑鍛戒护
-                    executeWork(liftProtocol.getTaskNo());
-                }
-
                 //灏嗘彁鍗囨満鐘舵�佷繚瀛樿嚦鏁版嵁搴�
                 BasLiftService liftService = SpringUtils.getBean(BasLiftService.class);
                 BasLift basLift = liftService.selectById(liftProtocol.getLiftNo());
@@ -244,6 +256,54 @@
         }
 
         command.setLiftNo(slave.getId().shortValue());
+        short[] array = getCommandArr(command);//鑾峰彇鍛戒护鎶ユ枃
+
+        try {
+            Thread.sleep(500);//鍛戒护涓嬪彂鍓嶄紤鐪�
+        } catch (InterruptedException e) {
+            throw new RuntimeException(e);
+        }
+
+        OperateResult result = modbusTcpNet.Write("41088", array);
+        if (result != null && result.IsSuccess) {
+            News.info("鎻愬崌鏈哄懡浠や笅鍙慬id:{}] >>>>> {}", slave.getId(), JSON.toJSON(command));
+            OutputQueue.LIFT.offer(MessageFormat.format("銆恵0}銆慬id:{1}] >>>>> 鍛戒护涓嬪彂锛� {2}", DateUtils.convert(new Date()), slave.getId(), JSON.toJSON(command)));
+
+            try {
+                Thread.sleep(500);//鍛戒护涓嬪彂鍚庝紤鐪�
+            } catch (InterruptedException e) {
+                throw new RuntimeException(e);
+            }
+
+            for (int i = 0; i < 5; i++) {
+                if (command.getRun().intValue() == 4 || command.getRun().intValue() == 5) {
+                    break;//绯荤粺澶嶄綅鍜岄摼鏉″仠姝㈣浆鍔ㄤ笉闇�瑕侀噸鍙�
+                }
+                readStatus();//閲嶆柊璇诲彇鐘舵��
+                if (liftProtocol.getRunning()) {
+                    break;
+                }
+
+                //鍒ゆ柇鏄惁杩愯涓紝濡備笉杩愯锛岄噸鏂颁笅鍙戝懡浠�
+                result = modbusTcpNet.Write("41088", array);
+                News.info("鎻愬崌鏈哄懡浠や笅鍙慬id:{}] >>>>> {},娆℃暟锛歿}", slave.getId(), JSON.toJSON(command), i);
+                OutputQueue.LIFT.offer(MessageFormat.format("銆恵0}銆慬id:{1}] >>>>> 鍛戒护涓嬪彂锛� {2},娆℃暟锛歿}", DateUtils.convert(new Date()), slave.getId(), JSON.toJSON(command), i));
+                try {
+                    Thread.sleep(300);//鍛戒护涓嬪彂鍚庝紤鐪�
+                } catch (InterruptedException e) {
+                    throw new RuntimeException(e);
+                }
+            }
+            return true;
+        } else {
+            OutputQueue.LIFT.offer(MessageFormat.format("銆恵0}銆戝啓鍏ユ彁鍗囨満plc鏁版嵁澶辫触 ===>> [id:{1}] [ip:{2}] [port:{3}],娆℃暟锛歿}", DateUtils.convert(new Date()), slave.getId(), slave.getIp(), slave.getPort()));
+            News.error("鍐欏叆鎻愬崌鏈簆lc鏁版嵁澶辫触 ===>> [id:{}] [ip:{}] [port:{}]", slave.getId(), slave.getIp(), slave.getPort());
+            return false;
+        }
+    }
+
+    //鑾峰彇鍛戒护鎶ユ枃
+    private short[] getCommandArr(LiftCommand command) {
         // 寮�濮嬩换鍔�
         short[] array = new short[30];
         //寮�濮嬭繍琛�
@@ -284,23 +344,7 @@
             tmp[1] = array[1];
             array = tmp;
         }
-
-        try {
-            Thread.sleep(1000);//鍛戒护涓嬪彂鍓嶄紤鐪�1s
-        } catch (InterruptedException e) {
-            throw new RuntimeException(e);
-        }
-
-        OperateResult result = modbusTcpNet.Write("41088", array);;
-        if (result != null && result.IsSuccess) {
-            News.info("鎻愬崌鏈哄懡浠や笅鍙慬id:{}] >>>>> {}", slave.getId(), JSON.toJSON(command));
-            OutputQueue.LIFT.offer(MessageFormat.format("銆恵0}銆慬id:{1}] >>>>> 鍛戒护涓嬪彂锛� {2}", DateUtils.convert(new Date()), slave.getId(), JSON.toJSON(command)));
-            return true;
-        } else {
-            OutputQueue.LIFT.offer(MessageFormat.format("銆恵0}銆戝啓鍏ユ彁鍗囨満plc鏁版嵁澶辫触 ===>> [id:{1}] [ip:{2}] [port:{3}]", DateUtils.convert(new Date()), slave.getId(), slave.getIp(), slave.getPort()));
-            News.error("鍐欏叆鎻愬崌鏈簆lc鏁版嵁澶辫触 ===>> [id:{}] [ip:{}] [port:{}]", slave.getId(), slave.getIp(), slave.getPort());
-            return false;
-        }
+        return array;
     }
 
     //鍒嗛厤浠诲姟
@@ -363,6 +407,7 @@
             return false;
         }
 
+        WrkMastMapper wrkMastMapper = SpringUtils.getBean(WrkMastMapper.class);
         Object o = redisUtil.get("lift_wrk_no_" + wrkNo);
         if (o == null) {
             return false;
@@ -375,12 +420,50 @@
         int size = commands.size();
         LiftAssignCommand assignCommand = redisCommand.getAssignCommand();
 
+        if (commandStep != 0) {
+            //鍒ゆ柇涓婁竴鏉℃寚浠ゆ槸鍚﹀畬鎴�
+            LiftCommand command = commands.get(commandStep - 1);
+            if (command.getRun().intValue() == 1) {
+                //鎻愬崌鏈哄崌闄嶅懡浠�
+                if (command.getDistPosition().intValue() == liftProtocol.getPositionArrivalFeedback().intValue()) {
+                    //鎻愬崌鏈虹洰鏍囨ゼ灞傚拰瀹為檯妤煎眰鐩稿悓锛屽垯璁ゅ畾鍛戒护瀹屾垚
+                    command.setComplete(true);
+                }
+            } else if (command.getRun().intValue() == 2 || command.getRun().intValue() == 3) {
+                //鏃犺揣姝h浆锛屾湁璐ф杞�
+                if (!liftProtocol.getForwardRotationFeedback()) {
+                    //杈撻�佺嚎姝h浆鍙嶉涓嶅湪杩愯涓紝璁ゅ畾鍛戒护瀹屾垚
+                    command.setComplete(true);
+                }
+            } else if (command.getRun().intValue() == 6 || command.getRun().intValue() == 7) {
+                //鏈夎揣鍙嶈浆锛屾棤璐у弽杞�
+                if (!liftProtocol.getReverseFeedback()) {
+                    //杈撻�佺嚎鍙嶈浆鍙嶉涓嶅湪杩愯涓紝璁ゅ畾鍛戒护瀹屾垚
+                    command.setComplete(true);
+                }
+            } else if (command.getRun().intValue() == 4) {
+                //杈撻�佺嚎鍋滄
+                if (!liftProtocol.getForwardRotationFeedback() && !liftProtocol.getReverseFeedback()) {
+                    //杈撻�佺嚎姝h浆鍙嶈浆閮戒笉鍦ㄨ繍琛屼腑锛岃瀹氬懡浠ゅ畬鎴�
+                    command.setComplete(true);
+                }
+            }
+            //浠诲姟鏁版嵁淇濆瓨鍒皉edis
+            redisUtil.set("lift_wrk_no_" + redisCommand.getWrkNo(), JSON.toJSONString(redisCommand));
+
+            if (!command.getComplete()) {
+                //涓婁竴鏉′换鍔℃湭瀹屾垚锛岀姝笅鍙戝懡浠�
+                return false;
+            }
+        }
+
         //鍙栧嚭鍛戒护
         LiftCommand command = commands.get(commandStep);
         if (command.getOperaStaNo() != null && command.getDevpId() != null) {
             //绔欑偣鍜岃緭閫佺嚎ID涓嶄负null锛岄渶瑕佷笅鍙戠珯鐐规寚浠よ皟搴︽寚瀹氱珯鐐硅繘琛岄摼鏉¤浆鍔�
             DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, command.getDevpId());
             StaProtocol staProtocol = devpThread.getStation().get(command.getOperaStaNo().intValue());
+            staProtocol = staProtocol.clone();
             if (!staProtocol.isLiftArrival()) {//閾炬潯杞姩鏉′欢锛岄渶瑕佹湁鎻愬崌鏈哄埌浣嶄俊鍙�
                 liftProtocol.setPakMk(true);
                 return false;
@@ -397,6 +480,24 @@
             boolean result1 = MessageQueue.offer(SlaveType.Devp, devpId, new Task(3, staProtocol));//涓嬪彂鍛戒护浣胯緭閫佺嚎閾炬潯杩愯浆
         }
 
+        WrkMast wrkMast = wrkMastMapper.selectByWorkNo(wrkNo.intValue());
+        if (wrkMast != null) {
+            if (wrkMast.getWrkSts() == 28) {//28.鎻愬崌鏈烘惉杩愪腑
+                if (command.getRun().intValue() == 1 && command.getDistPosition().intValue() == LiftLevType.TWO.lev) {
+                    //鎻愬崌鏈虹Щ鍔ㄤ笖浣嶇疆鏄埌杈撻�佺嚎妤煎眰锛岄渶瑕佸垽鏂珯鐐硅揣鐗╂槸鍚︽棤鐗╋紝鎻愬崌鏈烘槸鍚︽湁鐗�
+                    DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, command.getDevpId());
+                    //宸ヤ綔妗f簮搴撲綅妤煎眰
+                    int wrkMastLocNoLey = Utils.getLev(wrkMast.getSourceLocNo());
+                    StaProtocol staProtocol = devpThread.getStation().get(Utils.levToOutInStaNo(wrkMastLocNoLey >= 2 ? wrkMastLocNoLey + 1 : wrkMastLocNoLey));//璧峰绔欑偣
+                    //鍒ゆ柇杈撻�佺珯鐐规槸鍚︽湁鐗╋紝鍙湁鏃犵墿鎯呭喌鎵嶈兘缁х画璋冨害鎻愬崌鏈�
+                    if (staProtocol.isLoading()) {
+                        //鏈夌墿绂佹璋冨害
+                        return false;
+                    }
+                }
+            }
+        }
+
         //涓嬪彂鍛戒护
         if (!write(command)) {
             News.error("鎻愬崌鏈哄懡浠や笅鍙戝け璐ワ紝鎻愬崌鏈哄彿={}锛屼换鍔℃暟鎹�={}", command.getLiftNo(), JSON.toJSON(command));
@@ -411,6 +512,7 @@
             //淇濆瓨鏁版嵁鍒版暟鎹簱鍋氭祦姘�
             BasLiftOptService liftOptService = SpringUtils.getBean(BasLiftOptService.class);
             if (liftOptService != null) {
+                short[] commandArr = getCommandArr(command);//鑾峰彇鍛戒护鎶ユ枃
                 BasLiftOpt opt = new BasLiftOpt(
                         redisCommand.getWrkNo().intValue(),
                         redisCommand.getLiftNo().intValue(),
@@ -418,7 +520,8 @@
                         null,
                         null,
                         null,
-                        JSON.toJSONString(command)
+                        JSON.toJSONString(command),
+                        JSON.toJSONString(commandArr)
                 );
                 liftOptService.insert(opt);
             }
@@ -558,6 +661,7 @@
      * 鍒濆鍖栨彁鍗囨満
      */
     private void initLift() {
+        this.connect();
         if (null == liftProtocol) {
             liftProtocol = new LiftProtocol();
         }

--
Gitblit v1.9.1