diff --git a/Marlin/planner.cpp b/Marlin/planner.cpp
index 5487195565e0df71bb2b35ce9f4c995108a27e17..6a1fb548c2b2e3001259641aaac0b0a1c709f489 100644
--- a/Marlin/planner.cpp
+++ b/Marlin/planner.cpp
@@ -115,6 +115,8 @@ float Planner::min_feedrate_mm_s,
long Planner::position[NUM_AXIS] = { 0 };
+uint32_t Planner::cutoff_long;
+
float Planner::previous_speed[NUM_AXIS],
Planner::previous_nominal_speed;
@@ -1013,26 +1015,42 @@ void Planner::_buffer_line(const float &a, const float &b, const float &c, const
}
// Compute and limit the acceleration rate for the trapezoid generator.
- float steps_per_mm = block->step_event_count / block->millimeters;
+ float steps_per_mm = block->step_event_count * inverse_millimeters;
uint32_t accel;
if (!block->steps[X_AXIS] && !block->steps[Y_AXIS] && !block->steps[Z_AXIS]) {
// convert to: acceleration steps/sec^2
accel = ceil(retract_acceleration * steps_per_mm);
}
else {
- #define LIMIT_ACCEL(AXIS) do{ \
- if (max_acceleration_steps_per_s2[AXIS] < (accel * block->steps[AXIS]) / block->step_event_count) \
- accel = (max_acceleration_steps_per_s2[AXIS] * block->step_event_count) / block->steps[AXIS]; \
+ #define LIMIT_ACCEL_LONG(AXIS) do{ \
+ if (block->steps[AXIS] && max_acceleration_steps_per_s2[AXIS] < accel) { \
+ const uint32_t comp = max_acceleration_steps_per_s2[AXIS] * block->step_event_count; \
+ if (accel * block->steps[AXIS] > comp) accel = comp / block->steps[AXIS]; \
+ } \
+ }while(0)
+
+ #define LIMIT_ACCEL_FLOAT(AXIS) do{ \
+ if (block->steps[AXIS] && max_acceleration_steps_per_s2[AXIS] < accel) { \
+ const float comp = (float)max_acceleration_steps_per_s2[AXIS] * (float)block->step_event_count; \
+ if ((float)accel * (float)block->steps[AXIS] > comp) accel = comp / (float)block->steps[AXIS]; \
+ } \
}while(0)
// Start with print or travel acceleration
accel = ceil((block->steps[E_AXIS] ? acceleration : travel_acceleration) * steps_per_mm);
// Limit acceleration per axis
- LIMIT_ACCEL(X_AXIS);
- LIMIT_ACCEL(Y_AXIS);
- LIMIT_ACCEL(Z_AXIS);
- LIMIT_ACCEL(E_AXIS);
+ if (block->step_event_count <= cutoff_long){
+ LIMIT_ACCEL_LONG(X_AXIS);
+ LIMIT_ACCEL_LONG(Y_AXIS);
+ LIMIT_ACCEL_LONG(Z_AXIS);
+ LIMIT_ACCEL_LONG(E_AXIS);
+ } else {
+ LIMIT_ACCEL_FLOAT(X_AXIS);
+ LIMIT_ACCEL_FLOAT(Y_AXIS);
+ LIMIT_ACCEL_FLOAT(Z_AXIS);
+ LIMIT_ACCEL_FLOAT(E_AXIS);
+ }
}
block->acceleration_steps_per_s2 = accel;
block->acceleration = accel / steps_per_mm;
@@ -1303,8 +1321,12 @@ void Planner::set_position_mm(const AxisEnum axis, const float& v) {
// Recalculate the steps/s^2 acceleration rates, based on the mm/s^2
void Planner::reset_acceleration_rates() {
- LOOP_XYZE(i)
+ uint32_t highest_acceleration_allaxes_steps_per_s2;
+ LOOP_XYZE(i) {
max_acceleration_steps_per_s2[i] = max_acceleration_mm_per_s2[i] * axis_steps_per_mm[i];
+ if (max_acceleration_steps_per_s2[i] > highest_acceleration_allaxes_steps_per_s2) highest_acceleration_allaxes_steps_per_s2 = max_acceleration_steps_per_s2[i];
+ }
+ cutoff_long = 4294967295UL / highest_acceleration_allaxes_steps_per_s2;
}
// Recalculate position, steps_to_mm if axis_steps_per_mm changes!
diff --git a/Marlin/planner.h b/Marlin/planner.h
index 2e18a7066d26bdeb457d93eb4b61b48b9244c26a..cd4b3b97f5248172f60aea85b4fa0506e792f5c3 100644
--- a/Marlin/planner.h
+++ b/Marlin/planner.h
@@ -166,6 +166,11 @@ class Planner {
* Nominal speed of previous path line segment
*/
static float previous_nominal_speed;
+
+ /**
+ * Limit where 64bit math is necessary for acceleration calculation
+ */
+ static uint32_t cutoff_long;
#if ENABLED(DISABLE_INACTIVE_EXTRUDER)
/**