From 80d1f0fc9f35d5b84ee464b15c911214b2f69a73 Mon Sep 17 00:00:00 2001
From: Junjie <fallin.jie@qq.com>
Date: 星期五, 21 七月 2023 14:23:05 +0800
Subject: [PATCH] write5

---
 src/main/java/com/zy/core/thread/SteThread.java |  153 +++++++++++++++++++++++++++++++++++++++++++++-----
 1 files changed, 136 insertions(+), 17 deletions(-)

diff --git a/src/main/java/com/zy/core/thread/SteThread.java b/src/main/java/com/zy/core/thread/SteThread.java
index d02a3f3..72dbc49 100644
--- a/src/main/java/com/zy/core/thread/SteThread.java
+++ b/src/main/java/com/zy/core/thread/SteThread.java
@@ -5,16 +5,22 @@
 import HslCommunication.Profinet.Siemens.SiemensPLCS;
 import HslCommunication.Profinet.Siemens.SiemensS7Net;
 import com.alibaba.fastjson.JSON;
+import com.core.common.Cools;
 import com.core.common.DateUtils;
 import com.core.common.SpringUtils;
 import com.core.exception.CoolException;
 import com.zy.asrs.entity.BasSte;
 import com.zy.asrs.entity.BasSteOpt;
+import com.zy.asrs.entity.WrkCharge;
 import com.zy.asrs.service.BasSteOptService;
 import com.zy.asrs.service.BasSteService;
+import com.zy.common.model.enums.WrkChargeType;
+import com.zy.core.DevpThread;
+import com.zy.core.News;
 import com.zy.core.ThreadHandler;
 import com.zy.core.cache.MessageQueue;
 import com.zy.core.cache.OutputQueue;
+import com.zy.core.cache.SlaveConnection;
 import com.zy.core.enums.SlaveType;
 import com.zy.core.enums.SteStatusType;
 import com.zy.core.model.SteSlave;
@@ -105,10 +111,10 @@
         if(connect.IsSuccess){
             result = true;
             OutputQueue.STE.offer(MessageFormat.format( "銆恵0}銆戠┛姊溅plc杩炴帴鎴愬姛 ===>> [id:{1}] [ip:{2}] [port:{3}]", DateUtils.convert(new Date()), slave.getId(), slave.getIp(), slave.getPort()));
-            log.info("绌挎杞lc杩炴帴鎴愬姛 ===>> [id:{}] [ip:{}] [port:{}]", slave.getId(), slave.getIp(), slave.getPort());
+            News.info("绌挎杞lc杩炴帴鎴愬姛 ===>> [id:{}] [ip:{}] [port:{}]", slave.getId(), slave.getIp(), slave.getPort());
         } else {
             OutputQueue.STE.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());
+            News.error("绌挎杞lc杩炴帴澶辫触锛侊紒锛� ===>> [id:{}] [ip:{}] [port:{}]", slave.getId(), slave.getIp(), slave.getPort());
             initSte();
         }
 //        melsecMcNet.ConnectClose();
@@ -124,8 +130,9 @@
             if (result.IsSuccess) {
                 if (null == steProtocol) {
                     steProtocol = new SteProtocol();
+                    steProtocol.setSteNo(slave.getId().shortValue());
                 }
-                steProtocol.setSteNo(siemensS7Net.getByteTransform().TransInt16(result.Content, 0));
+//                steProtocol.setSteNo(siemensS7Net.getByteTransform().TransInt16(result.Content, 0));
                 steProtocol.setMode(siemensS7Net.getByteTransform().TransInt16(result.Content, 2));
                 steProtocol.setStatus(siemensS7Net.getByteTransform().TransInt16(result.Content, 4));
                 OperateResultExOne<Boolean> executeRes = siemensS7Net.ReadBool("V2001.0");
@@ -135,6 +142,14 @@
                 OperateResultExOne<Boolean> waitingRes = siemensS7Net.ReadBool("V2001.1");
                 if (waitingRes.IsSuccess) {
                     steProtocol.setWaiting(waitingRes.Content);
+                }
+                OperateResultExOne<Boolean> inEmptyRes = siemensS7Net.ReadBool("V2001.2");
+                if (inEmptyRes.IsSuccess) {
+                    steProtocol.setInEmpty(inEmptyRes.Content);
+                }
+                OperateResultExOne<Boolean> outEmptyRes = siemensS7Net.ReadBool("V2001.3");
+                if (outEmptyRes.IsSuccess) {
+                    steProtocol.setOutEmpty(outEmptyRes.Content);
                 }
                 steProtocol.setAlarm(siemensS7Net.getByteTransform().TransInt16(result.Content, 6));
                 steProtocol.setAlarm0(siemensS7Net.getByteTransform().TransInt16(result.Content, 8));
@@ -164,8 +179,77 @@
                 steProtocol.setCrnStopRun(siemensS7Net.getByteTransform().TransInt16(result.Content, 38));
                 steProtocol.setCrnStopFork(siemensS7Net.getByteTransform().TransInt16(result.Content, 40));
                 steProtocol.setCrnAllowRun(siemensS7Net.getByteTransform().TransInt16(result.Content, 42));
+//                steProtocol.setCrnAllowRun(siemensS7Net.getByteTransform().TransInt16(result.Content, 44));
+                SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, 1);
+                if (!devpThread.charge0 || devpThread.charge1){
+                    steProtocol.setChargeStatus((short)1);
+                }else {
+                    steProtocol.setChargeStatus((short)0);
+                }
 
                 OutputQueue.STE.offer(MessageFormat.format("銆恵0}銆慬id:{1}] <<<<< 瀹炴椂鏁版嵁鏇存柊鎴愬姛",DateUtils.convert(new Date()), slave.getId()));
+
+                //璇诲彇绌挎杞﹁澶囦俊鎭紝鎻愪緵鏌ヨ
+                OperateResultExOne<byte[]> result1 = siemensS7Net.Read("V732", (short) 16);
+                if (result1.IsSuccess) {
+                    boolean[] status = siemensS7Net.getByteTransform().TransBool(result1.Content, 0, 15);
+                    steProtocol.setLiftErr(status[0]);
+                    steProtocol.setInFetchErr(status[2]);
+                    steProtocol.setOutFetchErr(status[3]);
+                    steProtocol.setAntiErr(status[4]);
+                    steProtocol.setLiftSwitchErr(status[5]);
+                    steProtocol.setTrackErr(status[6]);
+                    steProtocol.setTimeoutErr(status[7]);
+                    steProtocol.setConnectErr(status[8]);
+                    steProtocol.setEmergencyErr(status[9]);
+                    steProtocol.setTaskTypeErr(status[10]);
+                    steProtocol.setTaskNoErr(status[11]);
+                    steProtocol.setNewTaskErr(status[12]);
+                    steProtocol.setErrTaskErr(status[13]);
+                    steProtocol.setStopErr(status[14]);
+                    steProtocol.setOfflineTaskErr(status[15]);
+                    steProtocol.setStartTaskErr(status[16]);
+                    steProtocol.setVoltageTaskErr(status[17]);
+
+                    steProtocol.setDevpErr(status[63]);
+
+                    steProtocol.setOnline(status[64]);
+                    steProtocol.setNotOnTrack(status[65]);
+                    steProtocol.setLowVoltage(status[66]);
+                    steProtocol.setElectricityLoss(status[67]);
+                    steProtocol.setForcedTravel(status[68]);
+                    steProtocol.setDemoMode(status[69]);
+                    steProtocol.setBrushConnect(status[70]);
+//                    if (status[70]){
+//                        steProtocol.setChargeStatus((short)1);
+//                    }
+                    steProtocol.setTaskManualForbid(status[71]);
+                    steProtocol.setOnlineManualForbid(status[72]);
+                    steProtocol.setDevpEmergency(status[73]);
+                    steProtocol.setTaskInterrupt(status[74]);
+                    steProtocol.setTaskClear(status[75]);
+                    steProtocol.setTaskConfirmTimeout(status[76]);
+                    steProtocol.setTaskWithCharge(status[77]);
+
+                    steProtocol.setPakInTask(status[96]);
+                    steProtocol.setPakOutTask(status[97]);
+                    steProtocol.setPakMoveTask(status[98]);
+                    steProtocol.setGoHpTask(status[99]);
+                    steProtocol.setGoOHpTask(status[100]);
+                    steProtocol.setGoHpAvoid(status[101]);
+                    steProtocol.setGoOHpAvoid(status[102]);
+                    steProtocol.setPakInEmpty(status[104]);
+                    steProtocol.setPakInFinish(status[105]);
+                    steProtocol.setPakOutEmpty(status[106]);
+                    steProtocol.setPakOutFinish(status[107]);
+                    steProtocol.setGoHpAvoidFinish(status[108]);
+                    steProtocol.setGoOHpAvoidFinish(status[109]);
+                    steProtocol.setGoHpAvoidErr(status[110]);
+                    steProtocol.setGoOHpAvoidErr(status[111]);
+
+                    steProtocol.setAutoMode(status[112]);
+                    steProtocol.setVoltageLow(status[113]);
+                }
 
                 // 澶嶄綅淇″彿
                 if (steProtocol.getWaiting()) {
@@ -177,7 +261,6 @@
                         }
                     }
                 }
-
 
                 // 鏍规嵁瀹炴椂淇℃伅鏇存柊鏁版嵁搴�
                 BasSteService service = SpringUtils.getBean(BasSteService.class);
@@ -191,7 +274,7 @@
                     BasSte basSte = new BasSte();
                     basSte.setSteNo(slave.getId());
                     if (!service.updateById(steProtocol.toSqlModel(basSte))){
-                        log.error("绌挎杞lc鏁版嵁搴撴洿鏂板け璐� ===>> [id:{}] [ip:{}] [port:{}]", slave.getId(), slave.getIp(), slave.getPort());
+                        News.error("绌挎杞lc鏁版嵁搴撴洿鏂板け璐� ===>> [id:{}] [ip:{}] [port:{}]", slave.getId(), slave.getIp(), slave.getPort());
                     }
 
                 }
@@ -200,9 +283,9 @@
                 throw new CoolException(MessageFormat.format( "绌挎杞lc鐘舵�佷俊鎭け璐� ===>> [id:{0}] [ip:{1}] [port:{2}]", slave.getId(), slave.getIp(), slave.getPort()));
             }
         } catch (Exception e) {
-            e.printStackTrace();
+//            e.printStackTrace();
             OutputQueue.STE.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());
+//            News.error("璇诲彇绌挎杞lc鐘舵�佷俊鎭け璐� ===>> [id:{}] [ip:{}] [port:{}]", slave.getId(), slave.getIp(), slave.getPort());
             initSte();
         }
 
@@ -213,13 +296,43 @@
      */
     private boolean write(SteCommand command){
         if (null == command) {
-            log.error("绌挎杞﹀啓鍏ュ懡浠や负绌�");
+            News.error("绌挎杞﹀啓鍏ュ懡浠や负绌�");
+            return false;
+        }
+        //鍒ゆ柇灏忚溅鏄惁鍦ㄥ厖鐢�
+        SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, 1);
+        if (devpThread.charge1){
+            // led 寮傚父鏄剧ず
+            LedThread ledThread1 = (LedThread) SlaveConnection.get(SlaveType.Led, 1);
+            LedThread ledThread2 = (LedThread) SlaveConnection.get(SlaveType.Led, 1);
+            LedThread ledThread3 = (LedThread) SlaveConnection.get(SlaveType.Led, 1);
+            if (ledThread1 != null && ledThread2 != null && ledThread3 != null) {
+                MessageQueue.offer(SlaveType.Led, 1, new Task(3, "绌挎杞︽鍦ㄥ厖鐢�"));
+                MessageQueue.offer(SlaveType.Led, 2, new Task(3, "绌挎杞︽鍦ㄥ厖鐢�"));
+                MessageQueue.offer(SlaveType.Led, 3, new Task(3, "绌挎杞︽鍦ㄥ厖鐢�"));
+            }
+            News.error("绌挎杞︽鍦ㄥ厖鐢�");
+            return false;
+        }else if (!devpThread.charge0){
+            // led 寮傚父鏄剧ず
+            LedThread ledThread1 = (LedThread) SlaveConnection.get(SlaveType.Led, 1);
+            LedThread ledThread2 = (LedThread) SlaveConnection.get(SlaveType.Led, 1);
+            LedThread ledThread3 = (LedThread) SlaveConnection.get(SlaveType.Led, 1);
+            if (ledThread1 != null && ledThread2 != null && ledThread3 != null) {
+                MessageQueue.offer(SlaveType.Led, 1, new Task(3, "绌挎杞﹀彲鑳藉湪绂荤嚎鍏呯數锛屾鏌ョ數鎺ф煖绌挎杞︽槸鍚﹀厖鐢垫々鍦ㄧ嚎"));
+                MessageQueue.offer(SlaveType.Led, 2, new Task(3, "绌挎杞﹀彲鑳藉湪绂荤嚎鍏呯數锛屾鏌ョ數鎺ф煖绌挎杞︽槸鍚﹀厖鐢垫々鍦ㄧ嚎"));
+                MessageQueue.offer(SlaveType.Led, 3, new Task(3, "绌挎杞﹀彲鑳藉湪绂荤嚎鍏呯數锛屾鏌ョ數鎺ф煖绌挎杞︽槸鍚﹀厖鐢垫々鍦ㄧ嚎"));
+            }
+            News.error("绌挎杞﹀彲鑳藉湪绂荤嚎鍏呯數锛屾鏌ョ數鎺ф煖绌挎杞︽槸鍚﹀厖鐢垫々鍦ㄧ嚎");
             return false;
         }
         command.setSteNo(slave.getId());
         OperateResult result = null;
         // 寮�濮嬩换鍔�
         if (!command.getComplete()) {
+            //缁勭粐浠诲姟鍓嶏紝鍏堟竻绌哄啓浠诲姟纭浣嶏紝浠ュ強浠诲姟瀹屾垚纭浣�
+            siemensS7Net.Write("V2000.0", false);
+            siemensS7Net.Write("V2000.1", false);
             // 1.浠诲姟鍙�
             OperateResult result0 = siemensS7Net.Write("V998", command.getTaskNo().shortValue());
             try {
@@ -234,6 +347,7 @@
                 // 3.纭寮�濮嬩换鍔�
                 if (result0.IsSuccess && result1.IsSuccess) {
                     result = siemensS7Net.Write("V2000.0", true);
+                    siemensS7Net.Write("V2000.1", false);
                 }
 
             // 鍏朵粬鎸囦护
@@ -258,7 +372,9 @@
 
         // 浠诲姟瀹屾垚
         } else {
-            siemensS7Net.Write("V1000",(short) 0);
+            siemensS7Net.Write("V2000.0", false);
+            siemensS7Net.Write("V998", (short) 0);
+            siemensS7Net.Write("V1000", (short) 0);
             result = siemensS7Net.Write("V2000.1", true);
         }
 
@@ -294,15 +410,17 @@
         if (result != null && result.IsSuccess) {
             // 缁存姢鏁版嵁搴撴帓鍒楀眰
             if (!steProtocol.getWaiting()) {
-                this.modifyPos(command.getRow().intValue(), command.getBay().intValue(), command.getLev().intValue());
+                if (!Cools.isEmpty(command.getRow(), command.getBay(), command.getLev())) {
+                    this.modifyPos(command.getRow().intValue(), command.getBay().intValue(), command.getLev().intValue());
+                }
             }
 
-            log.info("绌挎杞﹀懡浠や笅鍙慬id:{}] >>>>> {}", slave.getId(), JSON.toJSON(command));
+            News.info("绌挎杞﹀懡浠や笅鍙慬id:{}] >>>>> {}", slave.getId(), JSON.toJSON(command));
             OutputQueue.STE.offer(MessageFormat.format("銆恵0}銆慬id:{1}] >>>>> 鍛戒护涓嬪彂锛� {2}", DateUtils.convert(new Date()), slave.getId(), JSON.toJSON(command)));
             return true;
         } else {
             OutputQueue.STE.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());
+            News.error("鍐欏叆绌挎杞lc鏁版嵁澶辫触 ===>> [id:{}] [ip:{}] [port:{}]", slave.getId(), slave.getIp(), slave.getPort());
             return false;
         }
     }
@@ -310,7 +428,7 @@
     public void modifyPos(Integer row, Integer bay, Integer lev) {
         BasSteService service = SpringUtils.getBean(BasSteService.class);
         if (!service.updatePos(this.slave.getId(), row, bay, lev)) {
-            log.error("鏇存柊{}鍙风┛姊溅瀹氫綅澶辫触 ===>> 鎺掞細銆恵}銆�, 鍒楋細銆恵}銆戯紝灞傦細銆恵}銆�", this.slave.getId(), row, bay, lev);
+            News.error("鏇存柊{}鍙风┛姊溅瀹氫綅澶辫触 ===>> 鎺掞細銆恵}銆�, 鍒楋細銆恵}銆戯紝灞傦細銆恵}銆�", this.slave.getId(), row, bay, lev);
         }
     }
 
@@ -326,7 +444,7 @@
                 if (service.updatePakMk(this.slave.getId(), "N")) {
                     return true;
                 } else {
-                    log.error("{}鍙风┛姊溅淇敼鏁版嵁搴撳畾浣嶅け璐ワ紒锛侊紒", slave.getId());
+                    News.error("{}鍙风┛姊溅淇敼鏁版嵁搴撳畾浣嶅け璐ワ紒锛侊紒", slave.getId());
                 }
             }
         }
@@ -337,11 +455,12 @@
         short[] arr = new short[] {row.shortValue(), bay.shortValue(), lev.shortValue()};
         OperateResult result = siemensS7Net.Write("V1002", arr);
         if (!result.IsSuccess) {
+            News.error("鏇存柊{}鍙风┛姊溅瀹氫綅澶辫触 ===>> 鎺掞細銆恵}銆�, 鍒楋細銆恵}銆戯紝灞傦細銆恵}銆�", this.slave.getId(), row, bay, lev);
             return false;
         }
         BasSteService service = SpringUtils.getBean(BasSteService.class);
         if (!service.updatePos(this.slave.getId(), row, bay, lev)) {
-            log.error("鏇存柊{}鍙风┛姊溅瀹氫綅澶辫触 ===>> 鎺掞細銆恵}銆�, 鍒楋細銆恵}銆戯紝灞傦細銆恵}銆�", this.slave.getId(), row, bay, lev);
+            News.error("鏇存柊{}鍙风┛姊溅瀹氫綅澶辫触 ===>> 鎺掞細銆恵}銆�, 鍒楋細銆恵}銆戯紝灞傦細銆恵}銆�", this.slave.getId(), row, bay, lev);
             return false;
         }
         return true;
@@ -363,14 +482,14 @@
         }
         OperateResult write = siemensS7Net.Write("D10", heartBeatVal);
         if (!write.IsSuccess) {
-            log.error("杈撻�佺嚎plc缂栧彿={} 蹇冭烦澶辫触", slave.getId());
+            News.error("杈撻�佺嚎plc缂栧彿={} 蹇冭烦澶辫触", slave.getId());
         }
     }
 
 //    public void modifyPos(int wrkNo, int row, int bay, int lev) {
 //        BasSteService service = SpringUtils.getBean(BasSteService.class);
 //        if (!service.updatePos(wrkNo,this.slave.getId(), row, bay, lev)) {
-//            log.error("鏇存柊{}鍙风┛姊溅瀹氫綅澶辫触 ===>> 鎺掞細銆恵}銆�, 鍒楋細銆恵}銆戯紝灞傦細銆恵}銆�", this.slave.getId(), row, bay, lev);
+//            News.error("鏇存柊{}鍙风┛姊溅瀹氫綅澶辫触 ===>> 鎺掞細銆恵}銆�, 鍒楋細銆恵}銆戯紝灞傦細銆恵}銆�", this.slave.getId(), row, bay, lev);
 //        }
 //    }
 

--
Gitblit v1.9.1