From 21eac69df8b18ef44ab267a4e2efe714f985d8d9 Mon Sep 17 00:00:00 2001
From: Junjie <fallin.jie@qq.com>
Date: 星期六, 29 七月 2023 14:26:57 +0800
Subject: [PATCH] 提升机穿梭车配置

---
 src/main/java/com/zy/core/thread/LiftThread.java |  423 +++++++++++++++++++++++++++++++++-------------------
 1 files changed, 271 insertions(+), 152 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..8e1f381 100644
--- a/src/main/java/com/zy/core/thread/LiftThread.java
+++ b/src/main/java/com/zy/core/thread/LiftThread.java
@@ -4,14 +4,19 @@
 import HslCommunication.Core.Types.OperateResult;
 import HslCommunication.Core.Types.OperateResultExOne;
 import HslCommunication.ModBus.ModbusTcpNet;
+import HslCommunication.Profinet.Siemens.SiemensPLCS;
+import HslCommunication.Profinet.Siemens.SiemensS7Net;
 import com.alibaba.fastjson.JSON;
 import com.core.common.DateUtils;
 import com.core.common.SpringUtils;
 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;
@@ -21,7 +26,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.*;
@@ -42,7 +46,7 @@
 @Slf4j
 public class LiftThread implements  Runnable, ThreadHandler {
 
-    private ModbusTcpNet modbusTcpNet;
+    private SiemensS7Net siemensS7Net;
     private LiftSlave slave;
     private LiftProtocol liftProtocol;
     private RedisUtil redisUtil;
@@ -65,7 +69,7 @@
                 switch (step) {
                     // 璇绘暟鎹�
                     case 1:
-                        readStatus();
+                        read();
                         break;
                     // 鍐欏叆鏁版嵁
                     case 2:
@@ -89,10 +93,8 @@
     public boolean connect() {
         boolean result = false;
         //-------------------------鎻愬崌鏈鸿繛鎺ユ柟娉�------------------------//
-        modbusTcpNet = new ModbusTcpNet(slave.getIp(), slave.getPort(), (byte) 0x02);
-        // 褰撲綘闇�瑕佹寚瀹氭牸寮忕殑鏁版嵁瑙f瀽鏃讹紝灏遍渶瑕佽缃笅闈㈢殑杩欎釜淇℃伅
-        modbusTcpNet.setDataFormat(DataFormat.ABCD);
-        OperateResult connect = modbusTcpNet.ConnectServer();
+        siemensS7Net = new SiemensS7Net(SiemensPLCS.S1200, slave.getIp());
+        OperateResult connect = siemensS7Net.ConnectServer();
         if(connect.IsSuccess){
             result = true;
             OutputQueue.CRN.offer(MessageFormat.format( "銆恵0}銆戞彁鍗囨満plc杩炴帴鎴愬姛 ===>> [id:{1}] [ip:{2}] [port:{3}]", DateUtils.convert(new Date()), slave.getId(), slave.getIp(), slave.getPort()));
@@ -101,19 +103,40 @@
             OutputQueue.CRN.offer(MessageFormat.format("銆恵0}銆戞彁鍗囨満plc杩炴帴澶辫触锛侊紒锛� ===>> [id:{1}] [ip:{2}] [port:{3}]", DateUtils.convert(new Date()), slave.getId(), slave.getIp(), slave.getPort()));
             log.error("鎻愬崌鏈簆lc杩炴帴澶辫触锛侊紒锛� ===>> [id:{}] [ip:{}] [port:{}] ", slave.getId(), slave.getIp(), slave.getPort());
         }
-        modbusTcpNet.ConnectClose();
+        siemensS7Net.ConnectClose();
         //-------------------------鎻愬崌鏈鸿繛鎺ユ柟娉�------------------------//
         return result;
     }
 
     @Override
     public void close() {
-        modbusTcpNet.ConnectClose();
+        siemensS7Net.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()));
+        }
     }
 
     private void readStatus() {
         try {
-            OperateResultExOne<byte[]> result = modbusTcpNet.Read("41117", (short) 50);
+            OperateResultExOne<byte[]> result = siemensS7Net.Read("DB100.200", (short) 24);
             if (result.IsSuccess) {
                 if (null == liftProtocol) {
                     liftProtocol = new LiftProtocol();
@@ -122,108 +145,97 @@
 
                 //----------璇诲彇鎻愬崌鏈虹姸鎬�-----------
                 //鑾峰彇鏁版嵁
-                byte[] content = result.Content;
-                //鎻愬崌鏈洪攣瀹�
-                liftProtocol.setLiftLock(CommonUtils.shortToBoolean(modbusTcpNet.getByteTransform().TransInt16(content, 0)));
-                //浣嶇疆鍒拌揪鍙嶉
-                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]));
-
-
-                //鏈氨缁姸鎬�
-                liftProtocol.setNotReady(modbusTcpNet.getByteTransform().TransInt16(content,6));
-                //浼烘湇1閿欒
-                liftProtocol.setServoError1(modbusTcpNet.getByteTransform().TransInt16(content,8));
-                //浼烘湇2閿欒
-                liftProtocol.setServoError2(modbusTcpNet.getByteTransform().TransInt16(content,10));
-                //浼烘湇3閿欒
-                liftProtocol.setServoError3(modbusTcpNet.getByteTransform().TransInt16(content,12));
-                //浼烘湇4閿欒
-                liftProtocol.setServoError4(modbusTcpNet.getByteTransform().TransInt16(content,14));
-                //鎻愬崌鏈哄疄闄呴�熷害鍙嶉
-                liftProtocol.setLiftActualSpeed(modbusTcpNet.getByteTransform().TransInt16(content,16));
-
-                ///璇诲彇鎻愬崌鏈虹姸鎬�-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());
-                if (basLift == null) {
-                    basLift = new BasLift();
-                    //鎻愬崌鏈哄彿
-                    basLift.setLiftNo(slave.getId());
-                    liftService.insert(basLift);
-                }
-                basLift.setStatus(liftProtocol.getProtocolStatus());
-                basLift.setWrkNo(liftProtocol.getTaskNo().intValue());
-                basLift.setUpdateTime(new Date());
-                basLift.setPakMk(liftProtocol.getPakMk());
-                basLift.setLiftLock(liftProtocol.getLiftLock());
-                basLift.setPositionArrivalFeedback(liftProtocol.getPositionArrivalFeedback().intValue());
-                basLift.setReady(liftProtocol.getReady());
-                basLift.setRunning(liftProtocol.getRunning());
-                basLift.setMode(liftProtocol.getMode());
-                basLift.setLineFrontHasStock(liftProtocol.getLineFrontHasStock());
-                basLift.setForwardRotationFeedback(liftProtocol.getForwardRotationFeedback());
-                basLift.setReverseFeedback(liftProtocol.getReverseFeedback());
-                basLift.setMotorOverload(liftProtocol.getMotorOverload());
-                basLift.setLineEndHasStock(liftProtocol.getLineEndHasStock());
-                basLift.setInConveyLineCardTrayAlarm(liftProtocol.getInConveyLineCardTrayAlarm());
-                basLift.setOutConveyLineCardTrayAlarm(liftProtocol.getOutConveyLineCardTrayAlarm());
-                basLift.setPlatPositionDeviationAlarm(liftProtocol.getPlatPositionDeviationAlarm());
-                basLift.setPlatTorqueDeviationAlarm(liftProtocol.getPlatTorqueDeviationAlarm());
-                basLift.setPlatShuttleCheck(liftProtocol.getPlatShuttleCheck());
-                basLift.setNotReady(liftProtocol.getNotReady().intValue());
-                basLift.setServoError1(liftProtocol.getServoError1().intValue());
-                basLift.setServoError2(liftProtocol.getServoError2().intValue());
-                basLift.setServoError3(liftProtocol.getServoError3().intValue());
-                basLift.setServoError4(liftProtocol.getServoError4().intValue());
-                basLift.setLiftActualSpeed(liftProtocol.getLiftActualSpeed().intValue());
-                if (liftService.updateById(basLift)) {
-                    OutputQueue.LIFT.offer(MessageFormat.format("銆恵0}銆慬id:{1}] <<<<< 瀹炴椂鏁版嵁鏇存柊鎴愬姛",DateUtils.convert(new Date()), slave.getId()));
-//                    log.info(MessageFormat.format("銆恵0}銆慬id:{1}] <<<<< 瀹炴椂鏁版嵁鏇存柊鎴愬姛",DateUtils.convert(new Date()), slave.getId()));
-                }
+//                byte[] content = result.Content;
+//                //鎻愬崌鏈洪攣瀹�
+//                liftProtocol.setLiftLock(CommonUtils.shortToBoolean(modbusTcpNet.getByteTransform().TransInt16(content, 0)));
+//                //浣嶇疆鍒拌揪鍙嶉
+//                liftProtocol.setPositionArrivalFeedback(modbusTcpNet.getByteTransform().TransInt16(content,2));
+//
+//
+//                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));
+//                //浼烘湇1閿欒
+//                liftProtocol.setServoError1(modbusTcpNet.getByteTransform().TransInt16(content,8));
+//                //浼烘湇2閿欒
+//                liftProtocol.setServoError2(modbusTcpNet.getByteTransform().TransInt16(content,10));
+//                //浼烘湇3閿欒
+//                liftProtocol.setServoError3(modbusTcpNet.getByteTransform().TransInt16(content,12));
+//                //浼烘湇4閿欒
+//                liftProtocol.setServoError4(modbusTcpNet.getByteTransform().TransInt16(content,14));
+//                //鎻愬崌鏈哄疄闄呴�熷害鍙嶉
+//                liftProtocol.setLiftActualSpeed(modbusTcpNet.getByteTransform().TransInt16(content,16));
+//
+//                ///璇诲彇鎻愬崌鏈虹姸鎬�-end
+//
+//                //灏嗘彁鍗囨満鐘舵�佷繚瀛樿嚦鏁版嵁搴�
+//                BasLiftService liftService = SpringUtils.getBean(BasLiftService.class);
+//                BasLift basLift = liftService.selectById(liftProtocol.getLiftNo());
+//                if (basLift == null) {
+//                    basLift = new BasLift();
+//                    //鎻愬崌鏈哄彿
+//                    basLift.setLiftNo(slave.getId());
+//                    liftService.insert(basLift);
+//                }
+//                basLift.setStatus(liftProtocol.getProtocolStatus());
+//                basLift.setWrkNo(liftProtocol.getTaskNo().intValue());
+//                basLift.setUpdateTime(new Date());
+//                basLift.setPakMk(liftProtocol.getPakMk());
+//                basLift.setLiftLock(liftProtocol.getLiftLock());
+//                basLift.setPositionArrivalFeedback(liftProtocol.getPositionArrivalFeedback().intValue());
+//                basLift.setReady(liftProtocol.getReady());
+//                basLift.setRunning(liftProtocol.getRunning());
+//                basLift.setMode(liftProtocol.getMode());
+//                basLift.setLineFrontHasStock(liftProtocol.getLineFrontHasStock());
+//                basLift.setForwardRotationFeedback(liftProtocol.getForwardRotationFeedback());
+//                basLift.setReverseFeedback(liftProtocol.getReverseFeedback());
+//                basLift.setMotorOverload(liftProtocol.getMotorOverload());
+//                basLift.setLineEndHasStock(liftProtocol.getLineEndHasStock());
+//                basLift.setInConveyLineCardTrayAlarm(liftProtocol.getInConveyLineCardTrayAlarm());
+//                basLift.setOutConveyLineCardTrayAlarm(liftProtocol.getOutConveyLineCardTrayAlarm());
+//                basLift.setPlatPositionDeviationAlarm(liftProtocol.getPlatPositionDeviationAlarm());
+//                basLift.setPlatTorqueDeviationAlarm(liftProtocol.getPlatTorqueDeviationAlarm());
+//                basLift.setPlatShuttleCheck(liftProtocol.getPlatShuttleCheck());
+//                basLift.setNotReady(liftProtocol.getNotReady().intValue());
+//                basLift.setServoError1(liftProtocol.getServoError1().intValue());
+//                basLift.setServoError2(liftProtocol.getServoError2().intValue());
+//                basLift.setServoError3(liftProtocol.getServoError3().intValue());
+//                basLift.setServoError4(liftProtocol.getServoError4().intValue());
+//                basLift.setLiftActualSpeed(liftProtocol.getLiftActualSpeed().intValue());
+//                if (liftService.updateById(basLift)) {
+//                    OutputQueue.LIFT.offer(MessageFormat.format("銆恵0}銆慬id:{1}] <<<<< 瀹炴椂鏁版嵁鏇存柊鎴愬姛",DateUtils.convert(new Date()), slave.getId()));
+////                    log.info(MessageFormat.format("銆恵0}銆慬id:{1}] <<<<< 瀹炴椂鏁版嵁鏇存柊鎴愬姛",DateUtils.convert(new Date()), slave.getId()));
+//                }
 
             }else {
                 OutputQueue.LIFT.offer(MessageFormat.format("銆恵0}銆憑1}鎻愬崌鏈簆lc鐘舵�佷俊鎭け璐�", DateUtils.convert(new Date()), slave.getId()));
@@ -231,7 +243,6 @@
             }
         } 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();
         }
     }
 
@@ -241,7 +252,57 @@
             return false;
         }
 
-        command.setLiftNo(slave.getId().shortValue());
+//        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;
+//        }
+
+        return true;
+    }
+
+    //鑾峰彇鍛戒护鎶ユ枃
+    private short[] getCommandArr(LiftCommand command) {
         // 寮�濮嬩换鍔�
         short[] array = new short[30];
         //寮�濮嬭繍琛�
@@ -275,16 +336,14 @@
             array[29] = command.getLiftLockShortValue();
         }
 
-        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;
+        if (array[2] == 0) {
+            // 寮�濮嬩换鍔�
+            short[] tmp = new short[2];
+            tmp[0] = array[0];
+            tmp[1] = array[1];
+            array = tmp;
         }
+        return array;
     }
 
     //鍒嗛厤浠诲姟
@@ -347,9 +406,7 @@
             return false;
         }
 
-        //灏嗘爣璁扮疆涓篺alse(闃叉閲嶅彂)
-        liftProtocol.setPakMk(false);
-
+        WrkMastMapper wrkMastMapper = SpringUtils.getBean(WrkMastMapper.class);
         Object o = redisUtil.get("lift_wrk_no_" + wrkNo);
         if (o == null) {
             return false;
@@ -362,12 +419,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;
@@ -384,6 +479,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));
@@ -391,6 +504,26 @@
         }else {
             News.info("鎻愬崌鏈哄懡浠や笅鍙戞垚鍔燂紝鎻愬崌鏈哄彿={}锛屼换鍔℃暟鎹�={}", command.getLiftNo(), JSON.toJSON(command));
             liftProtocol.setWrkTime(new Date());//鏇存柊宸ヤ綔鏃堕棿
+
+            //灏嗘爣璁扮疆涓篺alse(闃叉閲嶅彂)
+            liftProtocol.setPakMk(false);
+
+            //淇濆瓨鏁版嵁鍒版暟鎹簱鍋氭祦姘�
+            BasLiftOptService liftOptService = SpringUtils.getBean(BasLiftOptService.class);
+            if (liftOptService != null) {
+                short[] commandArr = getCommandArr(command);//鑾峰彇鍛戒护鎶ユ枃
+                BasLiftOpt opt = new BasLiftOpt(
+                        redisCommand.getWrkNo().intValue(),
+                        redisCommand.getLiftNo().intValue(),
+                        new Date(),
+                        null,
+                        null,
+                        null,
+                        JSON.toJSONString(command),
+                        JSON.toJSONString(commandArr)
+                );
+                liftOptService.insert(opt);
+            }
 
             //鍒ゆ柇鏁版嵁鏄惁鎵ц瀹屾垚
             if (commandStep < size - 1) {
@@ -402,27 +535,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 +576,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 +594,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;
     }
 
@@ -542,6 +660,7 @@
      * 鍒濆鍖栨彁鍗囨満
      */
     private void initLift() {
+        this.connect();
         if (null == liftProtocol) {
             liftProtocol = new LiftProtocol();
         }

--
Gitblit v1.9.1