From 00d9f3f5cf3b046cb42098c9bc13f2313a435f53 Mon Sep 17 00:00:00 2001
From: Junjie <fallin.jie@qq.com>
Date: 星期二, 27 六月 2023 10:32:50 +0800
Subject: [PATCH] 提升机搬运前判断目标站是否可入

---
 src/main/java/com/zy/core/thread/LiftThread.java |  132 ++++++++++++++++++++++++-------------------
 1 files changed, 74 insertions(+), 58 deletions(-)

diff --git a/src/main/java/com/zy/core/thread/LiftThread.java b/src/main/java/com/zy/core/thread/LiftThread.java
index 70151e9..2504792 100644
--- a/src/main/java/com/zy/core/thread/LiftThread.java
+++ b/src/main/java/com/zy/core/thread/LiftThread.java
@@ -6,6 +6,7 @@
 import HslCommunication.ModBus.ModbusTcpNet;
 import com.alibaba.fastjson.JSON;
 import com.core.common.DateUtils;
+import com.core.common.RadixTools;
 import com.core.common.SpringUtils;
 import com.core.exception.CoolException;
 import com.zy.asrs.entity.BasLift;
@@ -21,7 +22,6 @@
 import com.zy.core.cache.OutputQueue;
 import com.zy.core.cache.SlaveConnection;
 import com.zy.core.enums.*;
-import com.zy.core.model.DevpSlave;
 import com.zy.core.model.LiftSlave;
 import com.zy.core.model.Task;
 import com.zy.core.model.command.*;
@@ -128,35 +128,37 @@
                 //浣嶇疆鍒拌揪鍙嶉
                 liftProtocol.setPositionArrivalFeedback(modbusTcpNet.getByteTransform().TransInt16(content,2));
 
-                byte by = modbusTcpNet.getByteTransform().TransByte(content, 5);
-                int[] datas = CommonUtils.byteToBits(by);
-                //鍑嗗灏辩华
-                liftProtocol.setReady(CommonUtils.intToBoolean(datas[0]));
-                //杩愯涓�
-                liftProtocol.setRunning(CommonUtils.intToBoolean(datas[1]));
-                //鑱旀満/鍗曟満
-                liftProtocol.setMode(CommonUtils.intToBoolean(datas[2]));
-                //杈撻�佺嚎鍓嶇鍏夌數鏈夎揣
-                liftProtocol.setLineFrontHasStock(CommonUtils.intToBoolean(datas[3]));
-                //杈撻�佺嚎姝h浆鍙嶉
-                liftProtocol.setForwardRotationFeedback(CommonUtils.intToBoolean(datas[4]));
-                //杈撻�佺嚎鍙嶈浆鍙嶉
-                liftProtocol.setReverseFeedback(CommonUtils.intToBoolean(datas[5]));
-                //杈撻�佺嚎鐢垫満杩囪浇
-                liftProtocol.setMotorOverload(CommonUtils.intToBoolean(datas[6]));
-                //杈撻�佺嚎鏈鍏夌數鏈夎揣
-                liftProtocol.setLineEndHasStock(CommonUtils.intToBoolean(datas[7]));
-                //杩涜緭閫佺嚎鍗℃墭鐩樻姤璀�
-                liftProtocol.setInConveyLineCardTrayAlarm(CommonUtils.intToBoolean(datas[8]));
-                //鍑鸿緭閫佺嚎鍗℃墭鐩樻姤璀�
-                liftProtocol.setOutConveyLineCardTrayAlarm(CommonUtils.intToBoolean(datas[9]));
-                //骞冲彴浣嶇疆鍋忓樊鎶ヨ
-                liftProtocol.setPlatPositionDeviationAlarm(CommonUtils.intToBoolean(datas[10]));
-                //骞冲彴鎵煩鍋忓樊鎶ヨ
-                liftProtocol.setPlatTorqueDeviationAlarm(CommonUtils.intToBoolean(datas[11]));
-                //骞冲彴鍥涘悜杞︽娴�
-                liftProtocol.setPlatShuttleCheck(CommonUtils.intToBoolean(datas[12]));
 
+                byte b1 = modbusTcpNet.getByteTransform().TransByte(content, 5);
+                byte b2 = modbusTcpNet.getByteTransform().TransByte(content, 4);
+                int[] datas1 = CommonUtils.byteToBits(b1);
+                int[] datas2 = CommonUtils.byteToBits(b2);
+                //鍑嗗灏辩华
+                liftProtocol.setReady(CommonUtils.intToBoolean(datas1[0]));
+                //杩愯涓�
+                liftProtocol.setRunning(CommonUtils.intToBoolean(datas1[1]));
+                //鑱旀満/鍗曟満
+                liftProtocol.setMode(CommonUtils.intToBoolean(datas1[2]));
+                //杈撻�佺嚎鍓嶇鍏夌數鏈夎揣
+                liftProtocol.setLineFrontHasStock(CommonUtils.intToBoolean(datas1[3]));
+                //杈撻�佺嚎姝h浆鍙嶉
+                liftProtocol.setForwardRotationFeedback(CommonUtils.intToBoolean(datas1[4]));
+                //杈撻�佺嚎鍙嶈浆鍙嶉
+                liftProtocol.setReverseFeedback(CommonUtils.intToBoolean(datas1[5]));
+                //杈撻�佺嚎鐢垫満杩囪浇
+                liftProtocol.setMotorOverload(CommonUtils.intToBoolean(datas1[6]));
+                //杈撻�佺嚎鏈鍏夌數鏈夎揣
+                liftProtocol.setLineEndHasStock(CommonUtils.intToBoolean(datas1[7]));
+                //杩涜緭閫佺嚎鍗℃墭鐩樻姤璀�
+                liftProtocol.setInConveyLineCardTrayAlarm(CommonUtils.intToBoolean(datas2[0]));
+                //鍑鸿緭閫佺嚎鍗℃墭鐩樻姤璀�
+                liftProtocol.setOutConveyLineCardTrayAlarm(CommonUtils.intToBoolean(datas2[1]));
+                //骞冲彴浣嶇疆鍋忓樊鎶ヨ
+                liftProtocol.setPlatPositionDeviationAlarm(CommonUtils.intToBoolean(datas2[2]));
+                //骞冲彴鎵煩鍋忓樊鎶ヨ
+                liftProtocol.setPlatTorqueDeviationAlarm(CommonUtils.intToBoolean(datas2[3]));
+                //骞冲彴鍥涘悜杞︽娴�
+                liftProtocol.setPlatShuttleCheck(CommonUtils.intToBoolean(datas2[4]));
 
                 //鏈氨缁姸鎬�
                 liftProtocol.setNotReady(modbusTcpNet.getByteTransform().TransInt16(content,6));
@@ -275,6 +277,20 @@
             array[29] = command.getLiftLockShortValue();
         }
 
+        if (array[2] == 0) {
+            // 寮�濮嬩换鍔�
+            short[] tmp = new short[2];
+            tmp[0] = array[0];
+            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));
@@ -347,9 +363,6 @@
             return false;
         }
 
-        //灏嗘爣璁扮疆涓篺alse(闃叉閲嶅彂)
-        liftProtocol.setPakMk(false);
-
         Object o = redisUtil.get("lift_wrk_no_" + wrkNo);
         if (o == null) {
             return false;
@@ -392,6 +405,24 @@
             News.info("鎻愬崌鏈哄懡浠や笅鍙戞垚鍔燂紝鎻愬崌鏈哄彿={}锛屼换鍔℃暟鎹�={}", command.getLiftNo(), JSON.toJSON(command));
             liftProtocol.setWrkTime(new Date());//鏇存柊宸ヤ綔鏃堕棿
 
+            //灏嗘爣璁扮疆涓篺alse(闃叉閲嶅彂)
+            liftProtocol.setPakMk(false);
+
+            //淇濆瓨鏁版嵁鍒版暟鎹簱鍋氭祦姘�
+            BasLiftOptService liftOptService = SpringUtils.getBean(BasLiftOptService.class);
+            if (liftOptService != null) {
+                BasLiftOpt opt = new BasLiftOpt(
+                        redisCommand.getWrkNo().intValue(),
+                        redisCommand.getLiftNo().intValue(),
+                        new Date(),
+                        null,
+                        null,
+                        null,
+                        JSON.toJSONString(command)
+                );
+                liftOptService.insert(opt);
+            }
+
             //鍒ゆ柇鏁版嵁鏄惁鎵ц瀹屾垚
             if (commandStep < size - 1) {
                 //鏇存柊redis鏁版嵁
@@ -402,27 +433,12 @@
                 redisUtil.set("lift_wrk_no_" + redisCommand.getWrkNo(), JSON.toJSONString(redisCommand));
             }else {
                 //宸叉墽琛屽畬鎴�
-                //淇濆瓨鏁版嵁鍒版暟鎹簱鍋氭祦姘�
-                BasLiftOptService liftOptService = SpringUtils.getBean(BasLiftOptService.class);
-                if (liftOptService != null) {
-                    BasLiftOpt opt = new BasLiftOpt(
-                            redisCommand.getWrkNo().intValue(),
-                            redisCommand.getLiftNo().intValue(),
-                            new Date(),
-                            null,
-                            null,
-                            null,
-                            JSON.toJSONString(assignCommand)
-                    );
-                    liftOptService.insert(opt);
-                }
                 //鍒犻櫎redis
                 redisUtil.del("lift_wrk_no_" + redisCommand.getWrkNo());
 
                 //瀵逛富绾跨▼鎶涘嚭绛夊緟纭鐘舵�亀aiting
                 liftProtocol.setProtocolStatus(LiftProtocolStatusType.WAITING);
-                News.info("鎻愬崌鏈轰换鍔℃墽琛屽畬鎴愮瓑寰呯‘璁や腑锛屾彁鍗囨満鍙�={}锛屼换鍔℃暟鎹�={}", command.getLiftNo(), JSON.toJSON(command));
-
+                News.info("鎻愬崌鏈轰换鍔℃墽琛屼笅鍙戝畬鎴愮瓑寰呮墽琛岀粨鏉燂紝鎻愬崌鏈哄彿={}锛屼换鍔℃暟鎹�={}", command.getLiftNo(), JSON.toJSON(command));
             }
         }
 
@@ -458,11 +474,11 @@
         command.setRun((short) 1);//鍗囬檷
         Short position = LiftLevType.getRealLev(lev);//鑾峰彇鎻愬崌鏈哄疄闄呮ゼ灞傛暟鍊�
         command.setDistPosition(position);
-        command.setSpeed((short) 200);
-        command.setHeight2((short) 180);
-        command.setHeight3((short) 1645);
-        command.setHeight4((short) (2 * 1645));
-        command.setHeight5((short) (3 * 1645));
+//        command.setSpeed((short) 200);
+//        command.setHeight2((short) 180);
+//        command.setHeight3((short) 1645);
+//        command.setHeight4((short) (2 * 1645));
+//        command.setHeight5((short) (3 * 1645));
         return command;
     }
 
@@ -476,11 +492,11 @@
         command.setLiftNo(liftNo);//鎻愬崌鏈哄彿
         command.setTaskNo(taskNo);//浠诲姟鍙�
         command.setDistPosition(position);//鐩爣妤煎眰
-        command.setSpeed((short) 200);
-        command.setHeight2((short) 180);
-        command.setHeight3((short) 1645);
-        command.setHeight4((short) 3290);
-        command.setHeight5((short) 4945);
+//        command.setSpeed((short) 200);
+//        command.setHeight2((short) 180);
+//        command.setHeight3((short) 1645);
+//        command.setHeight4((short) 3290);
+//        command.setHeight5((short) 4945);
         return command;
     }
 

--
Gitblit v1.9.1