From aa146b6fad8f892752e832dc874c050e4375451c Mon Sep 17 00:00:00 2001
From: 1 <1@123>
Date: 星期日, 11 五月 2025 16:54:39 +0800
Subject: [PATCH] #
---
src/main/java/com/zy/core/thread/RgvThread.java | 26 +++++++++++++++++++++++++-
1 files changed, 25 insertions(+), 1 deletions(-)
diff --git a/src/main/java/com/zy/core/thread/RgvThread.java b/src/main/java/com/zy/core/thread/RgvThread.java
index 1e6df7b..274eee4 100644
--- a/src/main/java/com/zy/core/thread/RgvThread.java
+++ b/src/main/java/com/zy/core/thread/RgvThread.java
@@ -52,7 +52,7 @@
//# 杞ㄩ亾鍩哄噯鐐�
private Long trackBenchmark = 1L;
// # 閬胯璺濈
- private Long avoidDistance = 4000L;
+ private Long avoidDistance = 5000L;
/**
* 宸ヤ綅1澶嶄綅淇″彿
@@ -343,6 +343,10 @@
log.error("琛岃蛋瓒呭嚭鑼冨洿锛侊紒锛佷换鍔″紓甯� 鑱旂郴绠＄悊鍛橈紒锛侊紒");
return false;
}
+ long avoidAbs = Math.abs(avoid - rgvProtocolOther.getRgvPos());
+ if (avoidAbs<51){
+ return false;
+ }
rgvTaskProtocolOther.setAvoid(1);
rgvTaskProtocolOther.setAvoidingTheDestination(avoid);
RgvTaskCache.updateRgvStatus(rgvTaskProtocolOther);
@@ -357,6 +361,10 @@
long avoid = targetPosition + rgvProtocol.getCarBodyKunPeng() + avoidDistance + rgvProtocolOther.getCarBodyJiaoMing();
if (!new TrackRangeUtils().avoidRange(avoid, avoidRange[0])) {
log.error("琛岃蛋瓒呭嚭鑼冨洿锛侊紒锛佷换鍔″紓甯� 鑱旂郴绠＄悊鍛橈紒锛侊紒");
+ return false;
+ }
+ long avoidAbs = Math.abs(avoid - rgvProtocolOther.getRgvPos());
+ if (avoidAbs<51){
return false;
}
rgvTaskProtocolOther.setAvoid(1);
@@ -374,6 +382,10 @@
long avoid = rgvProtocolOther.getRgvPos() - rgvProtocolOther.getCarBodyJiaoMing() - avoidDistance - rgvProtocol.getCarBodyKunPeng();
if (!new TrackRangeUtils().avoidRange(avoid, avoidRange[1])) {
log.error("琛岃蛋瓒呭嚭鑼冨洿锛侊紒锛佷换鍔″紓甯� 鑱旂郴绠＄悊鍛橈紒锛侊紒");
+ return false;
+ }
+ long avoidAbs = Math.abs(avoid - rgvProtocol.getRgvPos());
+ if (avoidAbs<51){
return false;
}
rgvTaskProtocol.setAvoid(1);
@@ -396,6 +408,10 @@
log.error("琛岃蛋瓒呭嚭鑼冨洿锛侊紒锛佷换鍔″紓甯� 鑱旂郴绠＄悊鍛橈紒锛侊紒");
return false;
}
+ long avoidAbs = Math.abs(avoid - rgvProtocolOther.getRgvPos());
+ if (avoidAbs<51){
+ return false;
+ }
rgvTaskProtocolOther.setAvoid(1);
rgvTaskProtocolOther.setAvoidingTheDestination(avoid);
RgvTaskCache.updateRgvStatus(rgvTaskProtocolOther);
@@ -410,6 +426,10 @@
long avoid = targetPosition - rgvProtocol.getCarBodyJiaoMing() - avoidDistance - rgvProtocolOther.getCarBodyKunPeng();
if (!new TrackRangeUtils().avoidRange(avoid, avoidRange[1])) {
log.error("琛岃蛋瓒呭嚭鑼冨洿锛侊紒锛佷换鍔″紓甯� 鑱旂郴绠＄悊鍛橈紒锛侊紒");
+ return false;
+ }
+ long avoidAbs = Math.abs(avoid - rgvProtocolOther.getRgvPos());
+ if (avoidAbs<51){
return false;
}
rgvTaskProtocolOther.setAvoid(1);
@@ -430,6 +450,10 @@
log.error("琛岃蛋瓒呭嚭鑼冨洿锛侊紒锛佷换鍔″紓甯� 鑱旂郴绠＄悊鍛橈紒锛侊紒");
return false;
}
+ long avoidAbs = Math.abs(avoid - rgvProtocol.getRgvPos());
+ if (avoidAbs<51){
+ return false;
+ }
rgvTaskProtocol.setAvoid(1);
rgvTaskProtocol.setAvoidingTheDestination(avoid);
RgvTaskCache.updateRgvStatus(rgvTaskProtocol);
--
Gitblit v1.9.1