From 3cf23392ce90c0a99835afe2db3a81206e093819 Mon Sep 17 00:00:00 2001 From: L <L@132> Date: 星期四, 25 九月 2025 10:02:20 +0800 Subject: [PATCH] Merge remote-tracking branch 'origin/jshdwcs' into jshdwcs --- src/main/java/com/zy/core/thread/RgvThread.java | 735 +++++++++++++++++++++++++++++++++++++++++-------------- 1 files changed, 544 insertions(+), 191 deletions(-) diff --git a/src/main/java/com/zy/core/thread/RgvThread.java b/src/main/java/com/zy/core/thread/RgvThread.java index 8920a92..4cfa9fa 100644 --- a/src/main/java/com/zy/core/thread/RgvThread.java +++ b/src/main/java/com/zy/core/thread/RgvThread.java @@ -18,6 +18,7 @@ import com.zy.core.cache.OutputQueue; import com.zy.core.enums.RgvStatusType; import com.zy.core.enums.RgvTaskModeType; +import com.zy.core.enums.RgvTaskStatusType; import com.zy.core.enums.SlaveType; import com.zy.core.model.RgvSlave; import com.zy.core.model.Task; @@ -52,6 +53,12 @@ //閿佸畾鏍囪 private boolean PakMk = true; + //鍏ュ簱鏍囪 + private boolean PakIn = true; + //鍑哄簱鏍囪 + private boolean PakOut = true; + //鏍规嵁璺濈璺宠繃鍙栬揣 + private boolean PakRgv = true; public RgvThread(RgvSlave slave) { this.slave = slave; @@ -73,18 +80,18 @@ case 1: readStatus(); break; -// // 宸ヤ綅1銆�2鍐欏叆鏁版嵁 -// case 2: -// write((RgvCommand) task.getData()); -// break; + // 宸ヤ綅1銆�2鍐欏叆鏁版嵁 + case 2: + write12((RgvCommand) task.getData()); + break; //宸ヤ綅1鍐欏叆鏁版嵁 case 4: write1((RgvCommand) task.getData()); break; // //宸ヤ綅2鍐欏叆鏁版嵁 -// case 5: -// write2((RgvCommand) task.getData()); -// break; + case 5: + write2((RgvCommand) task.getData()); + break; // 澶嶄綅 case 3: RgvCommand command = (RgvCommand) task.getData(); @@ -92,33 +99,81 @@ command = new RgvCommand(); } command.setRgvNo(slave.getId()); // RGV缂栧彿 - command.setTaskNo1((short) 0); // 宸ヤ綔鍙� - command.setAckFinish1((short) 1); // 浠诲姟瀹屾垚纭浣� - command.setTaskMode1(RgvTaskModeType.NONE); // 浠诲姟妯″紡 - command.setSourceStaNo1((short)0); // 婧愮珯 - command.setDestinationStaNo1((short)0); // 鐩爣绔� - command.setCommand((short)0); + command.setTaskNo1(0); // 宸ヤ綔鍙� + command.setAckFinish1(false); // 浠诲姟瀹屾垚纭浣� + command.setTaskStatus1(RgvTaskStatusType.NONE); // 浠诲姟妯″紡 + command.setTargetPosition1( 0); // 婧愮珯 + command.setEndStaNo1(0); // 鐩爣绔� + command.setWrkTaskMove1((short) 0); + command.setWrkTaskPri((short)0); + command.setCommand(false); write1(command); + break; + case 6: + RgvCommand command2 = (RgvCommand) task.getData(); + if (null == command2) { + command2 = new RgvCommand(); + } + command2.setRgvNo(slave.getId()); // RGV缂栧彿 + command2.setTaskNo2(0); // 宸ヤ綔鍙� + command2.setAckFinish2(false); // 浠诲姟瀹屾垚纭浣� + command2.setTaskStatus2(RgvTaskStatusType.NONE); // 浠诲姟妯″紡 + command2.setTargetPosition2(0); // 婧愮珯 + command2.setEndStaNo2(0); // 鐩爣绔� + command2.setWrkTaskPri((short)0); + command2.setWrkTaskMove2((short)0); + command2.setCommand(false); + write2(command2); + break; + case 7: //宸ヤ綅1鍙栬揣纭 + RgvCommand command3 = (RgvCommand) task.getData(); + if (null == command3) { + command3 = new RgvCommand(); + } + command3.setRgvNo(slave.getId()); // RGV缂栧彿 + command3.setAckFinish1(false); // 浠诲姟瀹屾垚纭浣� + command3.setTaskStatus1(RgvTaskStatusType.NONE); // 浠诲姟妯″紡 + command3.setTargetPosition1( 0); // 婧愮珯 + command3.setWrkTaskMove1(task.getMoveSta() !=null ? task.getMoveSta() : 0); + command3.setCommand(false); + command3.setWrkTaskPri((short)0); + command3.setTaskNo1(Math.toIntExact(task.getWorkNo())); + write1(command3); + break; + case 8 : + RgvCommand command4 = (RgvCommand) task.getData(); + if (null == command4) { + command4 = new RgvCommand(); + } + command4.setRgvNo(slave.getId()); // RGV缂栧彿 + command4.setAckFinish2(false); // 浠诲姟瀹屾垚纭浣� + command4.setTaskStatus2(RgvTaskStatusType.NONE); // 浠诲姟妯″紡 + command4.setTargetPosition2(0); // 灏忚溅鐩爣绔欐竻闆� + command4.setWrkTaskMove2(task.getMoveSta() !=null ? task.getMoveSta() : 0); + command4.setCommand(false); + command4.setWrkTaskPri((short)0); + command4.setTaskNo2(Math.toIntExact(task.getWorkNo())); + write2(command4); break; // 鍥炲師鐐� 閬胯 case 9: - RgvCommand commandAvoidanceXY = (RgvCommand) task.getData(); - if (null == commandAvoidanceXY) { - commandAvoidanceXY = new RgvCommand(); - } - commandAvoidanceXY.setRgvNo(slave.getId()); // RGV缂栧彿 - commandAvoidanceXY.setTaskNo1((short) 9999); // 宸ヤ綔鍙� - commandAvoidanceXY.setAckFinish1((short) 1); // 浠诲姟瀹屾垚纭浣� - commandAvoidanceXY.setTaskMode1(RgvTaskModeType.GO_ORIGIN); // 浠诲姟妯″紡 - commandAvoidanceXY.setSourceStaNo1((short)0); // 婧愮珯 - commandAvoidanceXY.setDestinationStaNo1((short)0); // 鐩爣绔� -// commandAvoidanceXY.setTaskNo2((short) 0); // 宸ヤ綔鍙� -// commandAvoidanceXY.setAckFinish2((short) 1); // 浠诲姟瀹屾垚纭浣� -// commandAvoidanceXY.setTaskMode2(RgvTaskModeType.GO_ORIGIN); // 浠诲姟妯″紡 -// commandAvoidanceXY.setSourceStaNo2((short)0); // 婧愮珯 -// commandAvoidanceXY.setDestinationStaNo2((short)0); // 鐩爣绔� - commandAvoidanceXY.setCommand((short)0); - write(commandAvoidanceXY); +// RgvCommand commandAvoidanceXY = (RgvCommand) task.getData(); +// if (null == commandAvoidanceXY) { +// commandAvoidanceXY = new RgvCommand(); +// } +// commandAvoidanceXY.setRgvNo(slave.getId()); // RGV缂栧彿 +// commandAvoidanceXY.setTaskNo1((short) 9999); // 宸ヤ綔鍙� +// commandAvoidanceXY.setAckFinish1((short) 1); // 浠诲姟瀹屾垚纭浣� +// commandAvoidanceXY.setTaskMode1(RgvTaskModeType.GO_ORIGIN); // 浠诲姟妯″紡 +// commandAvoidanceXY.setSourceStaNo1((short)0); // 婧愮珯 +// commandAvoidanceXY.setDestinationStaNo1((short)0); // 鐩爣绔� +//// commandAvoidanceXY.setTaskNo2((short) 0); // 宸ヤ綔鍙� +//// commandAvoidanceXY.setAckFinish2((short) 1); // 浠诲姟瀹屾垚纭浣� +//// commandAvoidanceXY.setTaskMode2(RgvTaskModeType.GO_ORIGIN); // 浠诲姟妯″紡 +//// commandAvoidanceXY.setSourceStaNo2((short)0); // 婧愮珯 +//// commandAvoidanceXY.setDestinationStaNo2((short)0); // 鐩爣绔� +// commandAvoidanceXY.setCommand((short)0); +// write(commandAvoidanceXY); break; default: break; @@ -138,20 +193,33 @@ if (null == rgvProtocol) { rgvProtocol = new RgvProtocol(); } - rgvProtocol.setMode((short) -1); + //灏忚溅鐘舵�� rgvProtocol.setStatus((short)-1); - rgvProtocol.setTaskNo1((short)0); + rgvProtocol.setRgvPosDestination(0); + rgvProtocol.setMode((short) -1); + rgvProtocol.setRgvPos(0); + rgvProtocol.setErr1(false); + rgvProtocol.setErr2(false); + rgvProtocol.setErr3(false); + rgvProtocol.setErr4(false); + rgvProtocol.setErr5(false); + rgvProtocol.setErr6(false); + rgvProtocol.setErr7(false); + rgvProtocol.setWrkTaskPri((short)0); + //宸ヤ綅1鐘舵�� + rgvProtocol.setTaskNo1(0); rgvProtocol.setStatus1((short)-1); - rgvProtocol.setLoaded1((short)0); - rgvProtocol.setWalkPos((short)0); - rgvProtocol.setRgvPos((short)0); -// rgvProtocol.setTaskNo2((short)0); -// rgvProtocol.setStatus2((short)-1); -// rgvProtocol.setLoaded2((short)0); - rgvProtocol.setAlarm((short)0); - rgvProtocol.setxSpeed((short) 0); - rgvProtocol.setxDistance((short) 0); - rgvProtocol.setxDuration((short) 0); + rgvProtocol.setLoaded1(false); + rgvProtocol.setWrkTaskMove1((short)0); + //宸ヤ綅2鐘舵�� + rgvProtocol.setTaskNo2(0); + rgvProtocol.setStatus2((short)-1); + rgvProtocol.setLoaded2(false); + rgvProtocol.setWrkTaskMove2((short)0); +// rgvProtocol.setAlarm((short)0); +// rgvProtocol.setxSpeed((short) 0); +// rgvProtocol.setxDistance((short) 0); +// rgvProtocol.setxDuration((short) 0); } @Override @@ -174,31 +242,65 @@ return result; } + private void setBool(byte[] buffer, int byteIndex, int bitIndex, boolean value) { + if (value) { + buffer[byteIndex] |= (1 << bitIndex); // 缃綅 + } else { + buffer[byteIndex] &= ~(1 << bitIndex); // 娓呴浂 + } + } + /** * 璇诲彇鐘舵�� */ private void readStatus(){ try { - OperateResultExOne<byte[]> result = siemensNet.Read("DB101.0", (short) 30); + OperateResultExOne<byte[]> result = siemensNet.Read("DB101.0", (short) 27); if (result.IsSuccess) { - if (null == rgvProtocol || rgvProtocol.getRgvNo() == null) { + if (null == rgvProtocol) { rgvProtocol = new RgvProtocol(); - rgvProtocol.setRgvNo(slave.getId()); + rgvProtocol.setRgvNo(siemensNet.getByteTransform().TransInt16(result.Content, 0)); + } - rgvProtocol.setMode(siemensNet.getByteTransform().TransInt16(result.Content, 0)); - rgvProtocol.setStatus(siemensNet.getByteTransform().TransInt16(result.Content, 2)); - rgvProtocol.setTaskNo1(siemensNet.getByteTransform().TransInt16(result.Content, 4)); - rgvProtocol.setStatus1(siemensNet.getByteTransform().TransInt16(result.Content, 6)); - rgvProtocol.setLoaded1(siemensNet.getByteTransform().TransInt16(result.Content, 8)); - rgvProtocol.setRgvPos(siemensNet.getByteTransform().TransInt16(result.Content, 10)); - rgvProtocol.setWalkPos(siemensNet.getByteTransform().TransInt16(result.Content, 12)); - rgvProtocol.setAlarm(siemensNet.getByteTransform().TransInt16(result.Content, 14)); + rgvProtocol.setMode(siemensNet.getByteTransform().TransInt16(result.Content, 2)); + rgvProtocol.setRgvPos(siemensNet.getByteTransform().TransInt32(result.Content, 4)); + rgvProtocol.setRgvPosDestination( siemensNet.getByteTransform().TransInt32(result.Content, 8)); + rgvProtocol.setStatus1(siemensNet.getByteTransform().TransInt16(result.Content, 12)); + rgvProtocol.setStatus2(siemensNet.getByteTransform().TransInt16(result.Content, 14)); + rgvProtocol.setTaskNo1(siemensNet.getByteTransform().TransInt32(result.Content, 16)); + rgvProtocol.setTaskNo2(siemensNet.getByteTransform().TransInt32(result.Content, 20)); + + boolean[] status1 = siemensNet.getByteTransform().TransBool(result.Content, 24, 2); + rgvProtocol.setLoaded1(status1[0]); + rgvProtocol.setLoaded2(status1[1]); + boolean[] status2 = siemensNet.getByteTransform().TransBool(result.Content, 26, 1); + rgvProtocol.setErr1(status2[0]); + rgvProtocol.setErr2(status2[1]); + rgvProtocol.setErr3(status2[2]); + rgvProtocol.setErr4(status2[3]); + rgvProtocol.setErr5(status2[4]); + rgvProtocol.setErr6(status2[5]); + rgvProtocol.setErr7(status2[6]); +// boolean[] status3 = siemensNet.getByteTransform().TransBool(result.Content, 27, 1); +// rgvProtocol.setErr1(status3[0]); +// rgvProtocol.setErr2(status3[1]); +// rgvProtocol.setErr3(status3[2]); +// rgvProtocol.setErr4(status3[3]); +// rgvProtocol.setErr5(status3[4]); +// rgvProtocol.setErr6(status3[5]); +// rgvProtocol.setErr7(status3[6]); + + +// rgvProtocol.setWalkPos(siemensNet.getByteTransform().TransInt16(result.Content, 12)); +// rgvProtocol.setAlarm(siemensNet.getByteTransform().TransInt16(result.Content, 14)); +// rgvProtocol.setTaskNo2(siemensNet.getByteTransform().TransInt16(result.Content, 4)); +// rgvProtocol.setLoaded2(siemensNet.getByteTransform().TransInt16(result.Content, 8)); // rgvProtocol.setStatus2(siemensNet.getByteTransform().TransInt16(result.Content, 16)); - rgvProtocol.setxSpeed(siemensNet.getByteTransform().TransInt16(result.Content, 18)); +// rgvProtocol.setxSpeed(siemensNet.getByteTransform().TransInt16(result.Content, 18)); // rgvProtocol.setAlarm(siemensNet.getByteTransform().TransInt16(result.Content, 20)); - rgvProtocol.setxDistance(siemensNet.getByteTransform().TransInt16(result.Content, 22)); +// rgvProtocol.setxDistance(siemensNet.getByteTransform().TransInt16(result.Content, 22)); // rgvProtocol.setTemp1(siemensNet.getByteTransform().TransInt16(result.Content, 24)); - rgvProtocol.setTemp2(siemensNet.getByteTransform().TransInt16(result.Content, 26)); +// rgvProtocol.setTemp2(siemensNet.getByteTransform().TransInt16(result.Content, 26)); // rgvProtocol.setTemp3(siemensNet.getByteTransform().TransInt16(result.Content, 28)); // rgvProtocol.setTemp4(siemensNet.getByteTransform().TransInt16(result.Content, 30)); // rgvProtocol.setTemp5(siemensNet.getByteTransform().TransInt16(result.Content, 32)); @@ -213,24 +315,24 @@ || rgvProtocol.getStatusType1().equals(RgvStatusType.FETCHWAITING)) { if (resetFlag1) { RgvCommand rgvCommand = new RgvCommand(); - rgvCommand.setAckFinish1((short)1); - if (write(rgvCommand)) { + rgvCommand.setAckFinish1(true); + if (write1(rgvCommand)) { resetFlag1 = false; } } } - // 宸ヤ綅2澶嶄綅淇″彿 -// if (rgvProtocol.getStatusType2().equals(RgvStatusType.WAITING) -// || rgvProtocol.getStatusType2().equals(RgvStatusType.FETCHWAITING)) { -// if (resetFlag2) { -// RgvCommand rgvCommand = new RgvCommand(); -// rgvCommand.setAckFinish2((short)1); -// if (write(rgvCommand)) { -// resetFlag2 = false; -// } -// } -// } +// 宸ヤ綅2澶嶄綅淇″彿 + if (rgvProtocol.getStatusType2().equals(RgvStatusType.WAITING) + || rgvProtocol.getStatusType2().equals(RgvStatusType.FETCHWAITING)) { + if (resetFlag2) { + RgvCommand rgvCommand = new RgvCommand(); + rgvCommand.setAckFinish2(true); + if (write2(rgvCommand)) { + resetFlag2 = false; + } + } + } try { // 鏍规嵁瀹炴椂淇℃伅鏇存柊鏁版嵁搴� @@ -261,96 +363,54 @@ /** * 宸ヤ綅1銆�2鍚屾椂鍐欏叆鏁版嵁 */ - private boolean write(RgvCommand command) throws InterruptedException { - if (null == command) { - log.error("RGV鍐欏叆鍛戒护涓虹┖"); - return false; - } -// convertRow(command); - command.setRgvNo(slave.getId()); - short[] array = new short[11]; - array[0] = command.getAckFinish1(); - array[1] = command.getTaskNo1(); - array[2] = command.getTaskMode1(); - array[3] = command.getSourceStaNo1(); - array[4] = command.getDestinationStaNo1(); -// array[0] = command.getAckFinish1(); -// array[1] = command.getTaskNo1(); -// array[2] = command.getTaskMode1(); -// array[3] = command.getSourceStaNo1(); -// array[4] = command.getDestinationStaNo1(); -// array[5] = command.getAckFinish2(); -// array[6] = command.getTaskNo2(); -// array[7] = command.getTaskMode2(); -// array[8] = command.getSourceStaNo2(); -// array[9] = command.getDestinationStaNo2(); -// array[10] = command.getCommand(); - OperateResult result = siemensNet.Write("DB100.0", array); - -// if (command.getAckFinish1() == 0 && command.getAckFinish2() == 0) { -// short commandFinish = 3; //宸ヤ綅1銆�2浠诲姟鍚屾椂鍐欏叆 -// Thread.sleep(100L); -// result = siemensNet.Write("DB100.20", commandFinish); -// } - - try { - // 鏃ュ織璁板綍 - BasRgvOptService bean = SpringUtils.getBean(BasRgvOptService.class); - BasRgvOpt basRgvOpt = new BasRgvOpt( - command.getTaskNo1().intValue(), - command.getTaskNo2().intValue(), - command.getRgvNo(), - new Date(), - command.getTaskModeType1().toString(), - command.getSourceStaNo1().intValue(), - command.getDestinationStaNo1().intValue(), - command.getSourceStaNo2().intValue(), - command.getDestinationStaNo2().intValue(), - null, - new Date(), - null - ); - bean.insert(basRgvOpt); - } catch (Exception ignore) {} - - if (result != null && result.IsSuccess) { - Thread.sleep(200); - this.readStatus(); - log.info("RGV 鍛戒护涓嬪彂[id:{}] >>>>> {}", slave.getId(), JSON.toJSON(command)); - OutputQueue.RGV.offer(MessageFormat.format("銆恵0}銆慬id:{1}] >>>>> 鍛戒护涓嬪彂锛� {2}", DateUtils.convert(new Date()), slave.getId(), JSON.toJSON(command))); - return true; - } else { - OutputQueue.RGV.offer(MessageFormat.format("銆恵0}銆戝啓鍏GV plc鏁版嵁澶辫触 ===>> [id:{1}] [ip:{2}] [port:{3}]", DateUtils.convert(new Date()), slave.getId(), slave.getIp(), slave.getPort())); - log.error("鍐欏叆RGV plc鏁版嵁澶辫触 ===>> [id:{}] [ip:{}] [port:{}]", slave.getId(), slave.getIp(), slave.getPort()); - return false; - } - } - - /** - * 宸ヤ綅1鍐欏叆鏁版嵁 - */ - private boolean write1(RgvCommand command) throws InterruptedException { + private boolean write12(RgvCommand command) throws InterruptedException { if (null == command) { log.error("RGV鍐欏叆鍛戒护涓虹┖"); return false; } -// siemensNet.Write("DB100.20", command.getCommand()); + OperateResultExOne<byte[]> result1 = siemensNet.Read("DB100.0", (short) 34); +// OperateResultExOne<byte[]> result4 = siemensNet.Read("DB100.10", (short) 2); + if (result1.IsSuccess){ + RgvCommand one = new RgvCommand(); + one.setTargetPosition1(siemensNet.getByteTransform().TransInt32(result1.Content, 0)); + one.setEndStaNo1(siemensNet.getByteTransform().TransInt32(result1.Content, 4)); + one.setTaskStatus1(siemensNet.getByteTransform().TransInt16(result1.Content, 8)); + one.setTaskNo1(siemensNet.getByteTransform().TransInt32(result1.Content, 10)); + one.setDirection1(siemensNet.getByteTransform().TransInt16(result1.Content, 14)); + one.setTargetPosition2(siemensNet.getByteTransform().TransInt32(result1.Content, 16)); + one.setEndStaNo2(siemensNet.getByteTransform().TransInt32(result1.Content, 20)); + one.setTaskStatus2(siemensNet.getByteTransform().TransInt16(result1.Content, 24)); + one.setTaskNo2(siemensNet.getByteTransform().TransInt32(result1.Content, 26)); + one.setDirection2(siemensNet.getByteTransform().TransInt16(result1.Content, 30)); + News.error("RGV鍛戒护涓嬪彂鍓嶈鍙栫姸鎬乕id:{}] >>>>> 鍐欏叆[{}],===>>鍥炶[{}]", slave.getId(), JSON.toJSON(command),JSON.toJSON(one)); + } + OperateResult result2 = siemensNet.Write("DB100.34", false); + if (result2.IsSuccess){ + News.error("涓嬪彂鍓嶆妸杞﹀瓙纭浣嶇疆涓篺alse"); + } + byte[] writeBytes = new byte[36]; command.setRgvNo(slave.getId()); - short[] array = new short[5]; - array[0] = command.getAckFinish1(); - array[1] = command.getTaskNo1(); - array[2] = command.getTaskMode1(); - array[3] = command.getSourceStaNo1(); - array[4] = command.getDestinationStaNo1(); - siemensNet.Write("DB100.10", command.getCommand()); + siemensNet.getByteTransform().TransInt32(writeBytes, 0, command.getTargetPosition1()); + siemensNet.getByteTransform().TransInt32(writeBytes, 4, command.getEndStaNo1()); + siemensNet.getByteTransform().TransInt16(writeBytes, 8, command.getTaskStatus1()); + siemensNet.getByteTransform().TransInt32(writeBytes, 10, command.getTaskNo1()); + siemensNet.getByteTransform().TransInt16(writeBytes, 14, command.getDirection1()); + setBool(writeBytes, 32, 0, command.getAckFinish1()); + siemensNet.getByteTransform().TransInt32(writeBytes, 16, command.getTargetPosition2()); + siemensNet.getByteTransform().TransInt32(writeBytes, 20, command.getEndStaNo2()); + siemensNet.getByteTransform().TransInt16(writeBytes, 24, command.getTaskStatus2()); + siemensNet.getByteTransform().TransInt32(writeBytes, 26, command.getTaskNo2()); + siemensNet.getByteTransform().TransInt16(writeBytes, 30, command.getDirection2()); + setBool(writeBytes, 32, 1, command.getAckFinish2()); + siemensNet.getByteTransform().TransInt16(writeBytes, 36, command.getWrkTaskPri()); - OperateResult result = siemensNet.Write("DB100.0", array); + OperateResult result = siemensNet.Write("DB100.0", writeBytes); if (!result.IsSuccess){ News.error("鍐欏叆RGVplc鏁版嵁澶辫触锛岄噸鏂版坊鍔犱换鍔″埌闃熷垪 ===> [id:{}],{}",slave.getId(),JSON.toJSON(command)); - MessageQueue.offer(SlaveType.Rgv,slave.getId(),new Task(4,command)); + MessageQueue.offer(SlaveType.Rgv,slave.getId(),new Task(2,command)); Thread.sleep(100); readStatus(); return false; @@ -359,20 +419,32 @@ //RGV浠诲姟鍐欏叆鍚庯紝鍥炶涓�娆★紝鐪嬫槸鍚︽垚鍔� Thread.sleep(400); try { - OperateResultExOne<byte[]> resultRead = siemensNet.Read("DB100.0", (short) 12); + OperateResultExOne<byte[]> resultRead = siemensNet.Read("DB100.0", (short) 36); if (resultRead.IsSuccess){ RgvCommand one = new RgvCommand(); -// one.setAckFinish1(siemensNet.getByteTransform().TransInt16(resultRead.Content, 0)); - one.setTaskNo1(siemensNet.getByteTransform().TransInt16(resultRead.Content, 2)); - one.setTaskMode1(siemensNet.getByteTransform().TransInt16(resultRead.Content, 4)); - one.setSourceStaNo1(siemensNet.getByteTransform().TransInt16(resultRead.Content, 6)); - one.setDestinationStaNo1(siemensNet.getByteTransform().TransInt16(resultRead.Content, 8)); + one.setDirection1(siemensNet.getByteTransform().TransInt16(resultRead.Content, 14)); + one.setTaskNo1(siemensNet.getByteTransform().TransInt32(resultRead.Content, 10)); + one.setTaskStatus1(siemensNet.getByteTransform().TransInt16(resultRead.Content, 8)); + one.setEndStaNo1(siemensNet.getByteTransform().TransInt32(resultRead.Content, 4)); + one.setTargetPosition1(siemensNet.getByteTransform().TransInt32(resultRead.Content, 0)); + one.setWrkTaskPri(siemensNet.getByteTransform().TransInt16(resultRead.Content, 36)); + one.setDirection2(siemensNet.getByteTransform().TransInt16(resultRead.Content, 30)); + one.setTaskNo2(siemensNet.getByteTransform().TransInt32(resultRead.Content, 26)); + one.setTaskStatus2(siemensNet.getByteTransform().TransInt16(resultRead.Content, 24)); + one.setEndStaNo2(siemensNet.getByteTransform().TransInt32(resultRead.Content, 20)); + one.setTargetPosition2(siemensNet.getByteTransform().TransInt32(resultRead.Content, 16)); if ( - !command.getTaskNo1().equals(one.getTaskNo1()) || - !command.getTaskMode1().equals(one.getTaskMode1()) || - !command.getSourceStaNo1().equals(one.getSourceStaNo1()) || - !command.getDestinationStaNo1().equals(one.getDestinationStaNo1()) - ){ + !command.getDirection1().equals(one.getDirection1()) || + !command.getTaskNo1().equals(one.getTaskNo1()) || + !command.getTaskStatus1().equals(one.getTaskStatus1()) || + !command.getEndStaNo1().equals(one.getEndStaNo1()) || + !command.getTargetPosition1().equals(one.getTargetPosition1()) || + !command.getDirection2().equals(one.getDirection2()) || + !command.getTaskNo2().equals(one.getTaskNo2()) || + !command.getTaskStatus2().equals(one.getTaskStatus2()) || + !command.getEndStaNo2().equals(one.getEndStaNo2()) || + !command.getTargetPosition2().equals(one.getTargetPosition2()) + ) { try{ News.error("RGV鍛戒护鍦板潃鍐欏叆鍚庡洖璇诲け璐id:{}] >>>>> 鍐欏叆[{}],===>>鍥炶[{}]", slave.getId(), JSON.toJSON(command),JSON.toJSON(one)); }catch (Exception e){ @@ -395,7 +467,7 @@ News.error("RGV鍛戒护鍦板潃鍐欏叆鍚庡洖璇诲嚭閿�"); } - if (command.getAckFinish1() == 0) { + if (command.getAckFinish1() || command.getAckFinish2()) { if (result.IsSuccess) { Thread.sleep(300); //浠诲姟涓嬪彂娆℃暟 @@ -403,15 +475,176 @@ do { writeCount2++; - short commandFinish = (short) 1; - result = siemensNet.Write("DB100.10", commandFinish); + boolean commandFinish = false; + boolean commandFinish2 = false; + result = siemensNet.Write("DB100.DBX32.0", commandFinish); + OperateResult result3 = siemensNet.Write("DB100.DBX32.1", commandFinish); + + if(result.IsSuccess && result3.IsSuccess){ + //RGV浠诲姟鍐欏叆鍚庯紝鍥炶涓�娆★紝鐪嬫槸鍚︽垚鍔� + Thread.sleep(200); + OperateResultExOne<byte[]> resultRead = siemensNet.Read("DB100.32", (short) 2); + if (resultRead.IsSuccess) { + commandFinish=siemensNet.getByteTransform().TransBool(resultRead.Content, 0); + commandFinish2=siemensNet.getByteTransform().TransBool(resultRead.Content, 1); + + if (!commandFinish && !commandFinish2) { + News.error("RGV浠诲姟纭浣�"+commandFinish+"鍐欏叆鏁版嵁涓庡洖璇绘暟鎹笉涓�鑷达紒"+"寰幆鎵ц娆℃暟:"+writeCount2+"娆�"); + }else{ + //浠诲姟鍛戒护鍐欏叆鎴愬姛 + News.info("RGV浠诲姟纭浣�"+commandFinish+"鍥炶鎴愬姛锛�"+"寰幆鎵ц娆℃暟:"+writeCount2+"娆�"); + break; + } + }else { + News.error("RGV浠诲姟纭浣�"+commandFinish+"鍥炶澶辫触锛�"+"寰幆鎵ц娆℃暟:"+writeCount2+"娆�"); + } + } else { + News.error("RGV浠诲姟纭浣�"+commandFinish+"鍐欏叆澶辫触锛�"+"寰幆鎵ц娆℃暟:"+writeCount2+"娆�"); + } + }while (writeCount2<5); + } + } + + + try { + // 鏃ュ織璁板綍 + BasRgvOptService bean = SpringUtils.getBean(BasRgvOptService.class); + BasRgvOpt basRgvOpt = new BasRgvOpt( + command.getTaskNo1(), + command.getTaskNo2(), + command.getRgvNo(), + new Date(), + command.getTargetPosition1() + ); + bean.insert(basRgvOpt); + } catch (Exception ignore) { + log.error(ignore.getMessage()); + } + + if (result != null && result.IsSuccess) { + Thread.sleep(200); + this.readStatus(); + log.info("RGV 宸ヤ綅1鍛戒护涓嬪彂[id:{}] >>>>> {}", slave.getId(), JSON.toJSON(command)); + OutputQueue.RGV.offer(MessageFormat.format("銆恵0}銆慬id:{1}] >>>>> 宸ヤ綅12鍛戒护涓嬪彂锛� {2}", DateUtils.convert(new Date()), slave.getId(), JSON.toJSON(command))); + return true; + } else { + OutputQueue.RGV.offer(MessageFormat.format("銆恵0}銆戝啓鍏GV plc宸ヤ綅12鏁版嵁澶辫触 ===>> [id:{1}] [ip:{2}] [port:{3}]", DateUtils.convert(new Date()), slave.getId(), slave.getIp(), slave.getPort())); + log.error("鍐欏叆RGV plc宸ヤ綅1鏁版嵁澶辫触 ===>> [id:{}] [ip:{}] [port:{}]", slave.getId(), slave.getIp(), slave.getPort()); + return false; + } + } + + /** + * 宸ヤ綅1鍐欏叆鏁版嵁 + */ + private boolean write1(RgvCommand command) throws InterruptedException { + if (null == command) { + log.error("RGV鍐欏叆鍛戒护涓虹┖"); + return false; + } + + OperateResultExOne<byte[]> result1 = siemensNet.Read("DB100.0", (short) 39); +// OperateResultExOne<byte[]> result4 = siemensNet.Read("DB100.10", (short) 2); + if (result1.IsSuccess){ + RgvCommand one = new RgvCommand(); + one.setTargetPosition1(siemensNet.getByteTransform().TransInt32(result1.Content, 0)); + one.setEndStaNo1(siemensNet.getByteTransform().TransInt32(result1.Content, 4)); + one.setTaskStatus1(siemensNet.getByteTransform().TransInt16(result1.Content, 8)); + one.setTaskNo1(siemensNet.getByteTransform().TransInt32(result1.Content, 10)); + one.setDirection1(siemensNet.getByteTransform().TransInt16(result1.Content, 14)); + one.setWrkTaskMove1(siemensNet.getByteTransform().TransInt16(result1.Content, 36)); + News.error("RGV鍛戒护涓嬪彂鍓嶈鍙栫姸鎬乕id:{}] >>>>> 鍐欏叆[{}],===>>鍥炶[{}]", slave.getId(), JSON.toJSON(command),JSON.toJSON(one)); + } + + + OperateResult result2 = siemensNet.Write("DB100.34", false); + if (result2.IsSuccess){ + News.error("涓嬪彂鍓嶆妸杞﹀瓙纭浣嶇疆涓篺alse"); + } + byte[] writeBytes = new byte[40]; + command.setRgvNo(slave.getId()); + + writeInt32(writeBytes, 0, command.getTargetPosition1()); + writeInt32(writeBytes, 4, command.getEndStaNo1()); + writeInt16(writeBytes, 8, (short)command.getTaskStatus1()); + writeInt32(writeBytes, 10, command.getTaskNo1()); + writeInt16(writeBytes, 14, (short)command.getDirection1()); + writeBool(writeBytes, 32, 0, command.getAckFinish1()); + writeInt16(writeBytes, 38, (short)command.getWrkTaskMove1()); + + OperateResult result = siemensNet.Write("DB100.0", writeBytes); + + + if (!result.IsSuccess){ + News.error("鍐欏叆RGVplc鏁版嵁澶辫触锛岄噸鏂版坊鍔犱换鍔″埌闃熷垪 ===> [id:{}],{}",slave.getId(),JSON.toJSON(command)); + MessageQueue.offer(SlaveType.Rgv,slave.getId(),new Task(4,command)); + Thread.sleep(100); + readStatus(); + return false; + } + + //RGV浠诲姟鍐欏叆鍚庯紝鍥炶涓�娆★紝鐪嬫槸鍚︽垚鍔� + Thread.sleep(400); + try { + OperateResultExOne<byte[]> resultRead = siemensNet.Read("DB100.0", (short) 39); + if (resultRead.IsSuccess){ + RgvCommand one = new RgvCommand(); + one.setWrkTaskMove1(siemensNet.getByteTransform().TransInt16(resultRead.Content, 38)); + one.setDirection1(siemensNet.getByteTransform().TransInt16(resultRead.Content, 14)); + one.setTaskNo1(siemensNet.getByteTransform().TransInt32(resultRead.Content, 10)); + one.setTaskStatus1(siemensNet.getByteTransform().TransInt16(resultRead.Content, 8)); + one.setEndStaNo1(siemensNet.getByteTransform().TransInt32(resultRead.Content, 4)); + one.setTargetPosition1(siemensNet.getByteTransform().TransInt32(resultRead.Content, 0)); + if ( + !command.getDirection1().equals(one.getDirection1()) || + !command.getTaskNo1().equals(one.getTaskNo1()) || + !command.getTaskStatus1().equals(one.getTaskStatus1()) || + !command.getEndStaNo1().equals(one.getEndStaNo1()) || + !command.getTargetPosition1().equals(one.getTargetPosition1()) || + !command.getWrkTaskMove1().equals(one.getWrkTaskMove1()) + ) { + try{ + News.error("RGV鍛戒护鍦板潃鍐欏叆鍚庡洖璇诲け璐id:{}] >>>>> 鍐欏叆[{}],===>>鍥炶[{}]", slave.getId(), JSON.toJSON(command),JSON.toJSON(one)); + }catch (Exception e){ + try{ + News.error("鏃ュ織鎵撳嵃澶辫触锛�===>>鍙傛暟one鎶ラ敊 [id:{}],{}", slave.getId(), JSON.toJSON(command),JSON.toJSON(resultRead)); + }catch (Exception e1){ + News.error("鏃ュ織鎵撳嵃澶辫触锛�===>> [id:{}],{}", slave.getId(), JSON.toJSON(command)); + } + } + News.error("Rgv鍛戒护鍥炶澶辫触鍚庯紝閲嶆柊娣诲姞浠诲姟鍒伴槦鍒� ===>> [id:{}],{}", slave.getId(), JSON.toJSON(command)); + MessageQueue.offer(SlaveType.Rgv, slave.getId(), new Task(4, command)); + Thread.sleep(100); + readStatus(); + return false; + }else { + News.info("RGV鍛戒护鍦板潃鍐欏叆鍚庡洖璇绘垚鍔焄id:{}] >>>>> 鍐欏叆[{}],===>>鍥炶[{}]", slave.getId(), JSON.toJSON(command),JSON.toJSON(one)); + } + } + }catch (Exception e){ + News.error("RGV鍛戒护鍦板潃鍐欏叆鍚庡洖璇诲嚭閿�"); + } + + if (!command.getAckFinish1()) { + if (result.IsSuccess) { + Thread.sleep(300); + //浠诲姟涓嬪彂娆℃暟 + int writeCount2 = 0; + + do { + writeCount2++; + boolean commandFinish = true; + if(command.getCommand()){ + commandFinish = false; + } + result = siemensNet.Write("DB100.32.0", commandFinish); if(result.IsSuccess){ //RGV浠诲姟鍐欏叆鍚庯紝鍥炶涓�娆★紝鐪嬫槸鍚︽垚鍔� Thread.sleep(200); - OperateResultExOne<byte[]> resultRead = siemensNet.Read("DB100.10", (short) 2); + OperateResultExOne<byte[]> resultRead = siemensNet.Read("DB100.32", (short) 2); if (resultRead.IsSuccess) { - commandFinish=siemensNet.getByteTransform().TransInt16(resultRead.Content, 0); - if (commandFinish != 1){ + commandFinish=siemensNet.getByteTransform().TransBool(resultRead.Content, 0); + if (commandFinish){ News.error("RGV浠诲姟纭浣�"+commandFinish+"鍐欏叆鏁版嵁涓庡洖璇绘暟鎹笉涓�鑷达紒"+"寰幆鎵ц娆℃暟:"+writeCount2+"娆�"); }else{ //浠诲姟鍛戒护鍐欏叆鎴愬姛 @@ -438,15 +671,12 @@ // 鏃ュ織璁板綍 BasRgvOptService bean = SpringUtils.getBean(BasRgvOptService.class); BasRgvOpt basRgvOpt = new BasRgvOpt( - command.getTaskNo1().intValue(), - command.getTaskNo2().intValue(), + command.getTaskNo1(), command.getRgvNo(), new Date(), - command.getTaskModeType1().toString(), - command.getSourceStaNo1().intValue(), - command.getDestinationStaNo1().intValue(), - command.getSourceStaNo2().intValue(), - command.getDestinationStaNo2().intValue(), + command.getTaskStatus1().toString(), + command.getTargetPosition1(), + command.getEndStaNo1(), null, new Date(), null @@ -478,36 +708,137 @@ return false; } + OperateResultExOne<byte[]> result1 = siemensNet.Read("DB100.0", (short) 40); + if (result1.IsSuccess){ + RgvCommand one = new RgvCommand(); + one.setTargetPosition1(siemensNet.getByteTransform().TransInt32(result1.Content, 0)); + one.setEndStaNo2(siemensNet.getByteTransform().TransInt32(result1.Content, 20)); + one.setTaskStatus2(siemensNet.getByteTransform().TransInt16(result1.Content, 24)); + one.setTaskNo2(siemensNet.getByteTransform().TransInt32(result1.Content, 26)); + one.setDirection2(siemensNet.getByteTransform().TransInt16(result1.Content, 30)); + one.setWrkTaskMove2(siemensNet.getByteTransform().TransInt16(result1.Content, 38)); + News.error("RGV鍛戒护涓嬪彂鍓嶈鍙栫姸鎬乕id:{}] >>>>> 鍐欏叆[{}],===>>鍥炶[{}]", slave.getId(), JSON.toJSON(command),JSON.toJSON(one)); + } + + + OperateResult result2 = siemensNet.Write("DB100.34", false); + if (result2.IsSuccess){ + News.error("涓嬪彂鍓嶆妸杞﹀瓙纭浣嶇疆涓�0"); + } + + + byte[] writeBytes = new byte[42]; command.setRgvNo(slave.getId()); - short[] array = new short[6]; - array[0] = command.getAckFinish2(); - array[1] = command.getTaskNo2(); - array[2] = command.getTaskMode2(); - array[3] = command.getSourceStaNo2(); - array[4] = command.getDestinationStaNo2(); - array[5] = command.getCommand(); - OperateResult result = siemensNet.Write("DB100.10", array); + writeInt32(writeBytes, 0, command.getTargetPosition1()); + writeInt32(writeBytes, 20, command.getEndStaNo2()); + writeInt16(writeBytes, 24, (short)command.getTaskStatus2()); + writeInt32(writeBytes, 26, command.getTaskNo2()); + writeInt16(writeBytes, 30, (short)command.getDirection2()); + writeBool(writeBytes, 32, 0, command.getAckFinish2()); + writeInt16(writeBytes, 38, (short)command.getWrkTaskMove2()); - if (command.getAckFinish2() == 0) { - short commandFinish = 2; //宸ヤ綅2浠诲姟鍐欏叆 - Thread.sleep(100L); - result = siemensNet.Write("DB100.20", commandFinish); + + OperateResult result = siemensNet.Write("DB100.0", writeBytes); + + + + if (!result.IsSuccess){ + News.error("鍐欏叆RGVplc鏁版嵁澶辫触锛岄噸鏂版坊鍔犱换鍔″埌闃熷垪 ===> [id:{}],{}",slave.getId(),JSON.toJSON(command)); + MessageQueue.offer(SlaveType.Rgv,slave.getId(),new Task(5,command)); + Thread.sleep(100); + readStatus(); + return false; + } + + //RGV浠诲姟鍐欏叆鍚庯紝鍥炶涓�娆★紝鐪嬫槸鍚︽垚鍔� + Thread.sleep(400); + try { + OperateResultExOne<byte[]> resultRead = siemensNet.Read("DB100.0", (short) 42); + if (resultRead.IsSuccess){ + RgvCommand one = new RgvCommand(); + one.setWrkTaskMove2(siemensNet.getByteTransform().TransInt16(resultRead.Content, 38)); + one.setDirection2(siemensNet.getByteTransform().TransInt16(resultRead.Content, 30)); + one.setTaskNo2(siemensNet.getByteTransform().TransInt32(resultRead.Content, 26)); + one.setTaskStatus2(siemensNet.getByteTransform().TransInt16(resultRead.Content, 24)); + one.setEndStaNo2(siemensNet.getByteTransform().TransInt32(resultRead.Content, 20)); + one.setTargetPosition1(siemensNet.getByteTransform().TransInt32(resultRead.Content, 0)); + if ( + !command.getDirection2().equals(one.getDirection2()) || + !command.getTaskNo2().equals(one.getTaskNo2()) || + !command.getTaskStatus2().equals(one.getTaskStatus2()) || + !command.getEndStaNo2().equals(one.getEndStaNo2()) || + !command.getTargetPosition1().equals(one.getTargetPosition1()) || + !command.getWrkTaskMove2().equals(one.getWrkTaskMove2()) + ) { + try{ + News.error("RGV鍛戒护鍦板潃鍐欏叆鍚庡洖璇诲け璐id:{}] >>>>> 鍐欏叆[{}],===>>鍥炶[{}]", slave.getId(), JSON.toJSON(command),JSON.toJSON(one)); + }catch (Exception e){ + try{ + News.error("鏃ュ織鎵撳嵃澶辫触锛�===>>鍙傛暟one鎶ラ敊 [id:{}],{}", slave.getId(), JSON.toJSON(command),JSON.toJSON(resultRead)); + }catch (Exception e1){ + News.error("鏃ュ織鎵撳嵃澶辫触锛�===>> [id:{}],{}", slave.getId(), JSON.toJSON(command)); + } + } + News.error("Rgv鍛戒护鍥炶澶辫触鍚庯紝閲嶆柊娣诲姞浠诲姟鍒伴槦鍒� ===>> [id:{}],{}", slave.getId(), JSON.toJSON(command)); + MessageQueue.offer(SlaveType.Rgv, slave.getId(), new Task(5, command)); + Thread.sleep(100); + readStatus(); + return false; + }else { + News.info("RGV鍛戒护鍦板潃鍐欏叆鍚庡洖璇绘垚鍔焄id:{}] >>>>> 鍐欏叆[{}],===>>鍥炶[{}]", slave.getId(), JSON.toJSON(command),JSON.toJSON(one)); + } + } + }catch (Exception e){ + News.error("RGV鍛戒护鍦板潃鍐欏叆鍚庡洖璇诲嚭閿�"); + } + + if (!command.getAckFinish2()) { + if (result.IsSuccess) { + Thread.sleep(300); + //浠诲姟涓嬪彂娆℃暟 + int writeCount2 = 0; + + do { + writeCount2++; + boolean commandFinish = true; + if(command.getCommand()){ + commandFinish = false; + } + result = siemensNet.Write("DB100.32.1", commandFinish); + if(result.IsSuccess){ + //RGV浠诲姟鍐欏叆鍚庯紝鍥炶涓�娆★紝鐪嬫槸鍚︽垚鍔� + Thread.sleep(200); + OperateResultExOne<byte[]> resultRead = siemensNet.Read("DB100.32", (short) 2); + if (resultRead.IsSuccess) { + commandFinish=siemensNet.getByteTransform().TransBool(resultRead.Content, 1); + if (commandFinish){ + News.error("RGV浠诲姟纭浣�"+commandFinish+"鍐欏叆鏁版嵁涓庡洖璇绘暟鎹笉涓�鑷达紒"+"寰幆鎵ц娆℃暟:"+writeCount2+"娆�"); + }else{ + //浠诲姟鍛戒护鍐欏叆鎴愬姛 + News.info("RGV浠诲姟纭浣�"+commandFinish+"鍥炶鎴愬姛锛�"+"寰幆鎵ц娆℃暟:"+writeCount2+"娆�"); + break; + } + }else { + News.error("RGV浠诲姟纭浣�"+commandFinish+"鍥炶澶辫触锛�"+"寰幆鎵ц娆℃暟:"+writeCount2+"娆�"); + } + } else { + News.error("RGV浠诲姟纭浣�"+commandFinish+"鍐欏叆澶辫触锛�"+"寰幆鎵ц娆℃暟:"+writeCount2+"娆�"); + } + }while (writeCount2<5); + } } try { // 鏃ュ織璁板綍 BasRgvOptService bean = SpringUtils.getBean(BasRgvOptService.class); BasRgvOpt basRgvOpt = new BasRgvOpt( - command.getTaskNo1().intValue(), - command.getTaskNo2().intValue(), + command.getTaskNo2(), command.getRgvNo(), new Date(), - command.getTaskModeType1().toString(), - command.getSourceStaNo1().intValue(), - command.getDestinationStaNo1().intValue(), - command.getSourceStaNo2().intValue(), - command.getDestinationStaNo2().intValue(), + command.getTaskStatus2().toString(), + command.getTargetPosition2(), + command.getEndStaNo2(), null, new Date(), null @@ -527,6 +858,28 @@ return false; } } + public static void writeInt32(byte[] buffer, int index, int value) { + buffer[index] = (byte)((value >> 24) & 0xFF); + buffer[index + 1] = (byte)((value >> 16) & 0xFF); + buffer[index + 2] = (byte)((value >> 8) & 0xFF); + buffer[index + 3] = (byte)(value & 0xFF); + } + + + public static void writeInt16(byte[] buffer, int index, short value) { + buffer[index] = (byte)((value >> 8) & 0xFF); // 楂樺瓧鑺� + buffer[index + 1] = (byte)(value & 0xFF); // 浣庡瓧鑺� + } + + public static void writeBool(byte[] buffer, int byteIndex, int bitIndex, boolean value) { + if (value) { + buffer[byteIndex] |= (1 << bitIndex); + } else { + buffer[byteIndex] &= ~(1 << bitIndex); + } + } + + @Override public void close() { -- Gitblit v1.9.1