yysh12 4 роки тому
джерело
коміт
bab660ca7d
Аккаунт користувача з таким Email не знайдено
1 змінених файлів з 9 додано та 4 видалено
  1. 9
    4
      Marlin/src/gcode/motion/G2_G3.cpp

+ 9
- 4
Marlin/src/gcode/motion/G2_G3.cpp Переглянути файл

@@ -77,16 +77,21 @@ void plan_arc(
77 77
               rt_Y = cart[q_axis] - center_Q,
78 78
               start_L = current_position[l_axis];
79 79
 
80
-  // CCW angle of rotation between position and target from the circle center. Only one atan2() trig computation required.
80
+  // Angle of rotation between position and target from the circle center.
81 81
   float angular_travel = ATAN2(rvec.a * rt_Y - rvec.b * rt_X, rvec.a * rt_X + rvec.b * rt_Y);
82
-  if (angular_travel < 0) angular_travel += RADIANS(360);
82
+
83
+  // Make sure angular travel over 180 degrees goes the other way around.
84
+  switch (((angular_travel < 0) << 1) + clockwise) {
85
+    case 1: angular_travel -= RADIANS(360); break; // Positive but CW? Reverse direction.
86
+    case 2: angular_travel += RADIANS(360); break; // Negative but CCW? Reverse direction.
87
+  }
88
+
83 89
   #ifdef MIN_ARC_SEGMENTS
84
-    uint16_t min_segments = CEIL((MIN_ARC_SEGMENTS) * (angular_travel / RADIANS(360)));
90
+    uint16_t min_segments = CEIL((MIN_ARC_SEGMENTS) * ABS(angular_travel) / RADIANS(360));
85 91
     NOLESS(min_segments, 1U);
86 92
   #else
87 93
     constexpr uint16_t min_segments = 1;
88 94
   #endif
89
-  if (clockwise) angular_travel -= RADIANS(360);
90 95
 
91 96
   // Make a circle if the angular rotation is 0 and the target is current position
92 97
   if (NEAR_ZERO(angular_travel) && NEAR(current_position[p_axis], cart[p_axis]) && NEAR(current_position[q_axis], cart[q_axis])) {

Завантаження…
Відмінити
Зберегти