From 3fc78a8fcd40d95ac534456b9512a55fc6a1cd02 Mon Sep 17 00:00:00 2001
From: fcl <2136892861@qq.com>
Date: Sat, 17 Jan 2026 14:34:46 +0800
Subject: [PATCH] =?UTF-8?q?=E6=94=B9=E5=8A=A8=E5=BA=95=E7=9B=98=E6=9C=80?=
 =?UTF-8?q?=E5=B0=8F=E8=BF=90=E7=AE=97=E8=A7=92=E5=BA=A6?=
MIME-Version: 1.0
Content-Type: text/plain; charset=UTF-8
Content-Transfer-Encoding: 8bit

---
 application/chassis/chassis.c | 8 ++++----
 1 file changed, 4 insertions(+), 4 deletions(-)

diff --git a/application/chassis/chassis.c b/application/chassis/chassis.c
index 41b6e10..a4a260a 100644
--- a/application/chassis/chassis.c
+++ b/application/chassis/chassis.c
@@ -232,7 +232,7 @@ static void MinmizeRotation(float *angle, const float *last_angle, float *speed)
     while (norm_rotation < -180.0f) {
         norm_rotation += 360.0f;
     }
-    float threshold = 90.0f;
+    float threshold = 110.0f;
     float target_single=fmodf(target_angle,360.0f);
     if(target_single<0.0f) target_single+=360.0f;
 
@@ -241,15 +241,15 @@ static void MinmizeRotation(float *angle, const float *last_angle, float *speed)
 
 
     if (fabsf(norm_rotation) > threshold) {
-        int32_t round_diff = (int32_t)(target_angle / 360.0f) - (int32_t)(actual_angle / 360.0f);
+        int32_t round_diff = (int32_t)((target_angle-actual_angle) / 360.0f);
         *angle = actual_angle + norm_rotation-180.0f+round_diff*360.0f;
         *speed = -(*speed);
     }else if(norm_rotation<-threshold){
-        int32_t round_diff = (int32_t)(target_angle / 360.0f) - (int32_t)(actual_angle / 360.0f);
+        int32_t round_diff = (int32_t)((target_angle-actual_angle) / 360.0f);
         *angle = actual_angle + norm_rotation+180.0f+round_diff*360.0f;
         *speed = -(*speed);
     }
-    ANGLE_LIMIT_360_TO_180_ABS(*angle);
+    // ANGLE_LIMIT_360_TO_180_ABS(*angle);
     // float rotation = *angle - *last_angle;
     // ANGLE_LIMIT_360_TO_180_ABS(rotation);
     // if (rotation > 90) {