From 5f3aa14af4f0e0a2ea79240237b39a868ca25900 Mon Sep 17 00:00:00 2001
From: Junjie <fallin.jie@qq.com>
Date: 星期三, 06 五月 2026 18:44:34 +0800
Subject: [PATCH] #
---
src/main/java/com/zy/core/network/real/ZyCrnV2RealConnect.java | 51 +++++++++++++++++++++++++++++++++++++++++++++++++++
1 files changed, 51 insertions(+), 0 deletions(-)
diff --git a/src/main/java/com/zy/core/network/real/ZyCrnV2RealConnect.java b/src/main/java/com/zy/core/network/real/ZyCrnV2RealConnect.java
index 4049203..5162732 100644
--- a/src/main/java/com/zy/core/network/real/ZyCrnV2RealConnect.java
+++ b/src/main/java/com/zy/core/network/real/ZyCrnV2RealConnect.java
@@ -141,6 +141,13 @@
return response;
}
+ boolean commandAreaClearResult = clearCommandArea();
+ if (!commandAreaClearResult) {
+ News.error("鍫嗗灈鏈哄懡浠ゅ尯娓呯┖澶辫触 ===>> [id:{}]", command.getCrnNo());
+ response.setMessage("鍫嗗灈鏈哄懡浠ゅ尯娓呯┖澶辫触");
+ return response;
+ }
+
short[] array = new short[9];
array[0] = command.getAckFinish().shortValue();
array[1] = command.getTaskNo().shortValue();
@@ -228,4 +235,48 @@
}
return response;
}
+
+ private boolean clearCommandArea() throws InterruptedException {
+ short[] array = new short[10];
+
+ int clearIdx = 0;
+ do {
+ OperateResult result = siemensNet.Write("DB100.0", array);
+ if (result.IsSuccess) {
+ OperateResultExOne<byte[]> resultRead = siemensNet.Read("DB100.0", (short) 20);
+ if (resultRead.IsSuccess && isCommandAreaEmpty(resultRead.Content)) {
+ return true;
+ }
+ }
+
+ clearIdx++;
+ Thread.sleep(200);
+ } while (clearIdx < 5);
+
+ return false;
+ }
+
+ private boolean isCommandAreaEmpty(byte[] content) {
+ short ackFinish = siemensNet.getByteTransform().TransInt16(content, 0);
+ short taskNo = siemensNet.getByteTransform().TransInt16(content, 2);
+ short taskMode = siemensNet.getByteTransform().TransInt16(content, 4);
+ short sourcePosX = siemensNet.getByteTransform().TransInt16(content, 6);
+ short sourcePosY = siemensNet.getByteTransform().TransInt16(content, 8);
+ short sourcePosZ = siemensNet.getByteTransform().TransInt16(content, 10);
+ short destinationPosX = siemensNet.getByteTransform().TransInt16(content, 12);
+ short destinationPosY = siemensNet.getByteTransform().TransInt16(content, 14);
+ short destinationPosZ = siemensNet.getByteTransform().TransInt16(content, 16);
+ short confirm = siemensNet.getByteTransform().TransInt16(content, 18);
+
+ return ackFinish == 0
+ && taskNo == 0
+ && taskMode == 0
+ && sourcePosX == 0
+ && sourcePosY == 0
+ && sourcePosZ == 0
+ && destinationPosX == 0
+ && destinationPosY == 0
+ && destinationPosZ == 0
+ && confirm == 0;
+ }
}
--
Gitblit v1.9.1