|
@ -11193,8 +11193,12 @@ void set_current_from_steppers_for_axis(const AxisEnum axis) { |
|
|
if (!position_is_reachable_xy(ltarget[X_AXIS], ltarget[Y_AXIS])) return true; |
|
|
if (!position_is_reachable_xy(ltarget[X_AXIS], ltarget[Y_AXIS])) return true; |
|
|
|
|
|
|
|
|
// Get the cartesian distances moved in XYZE
|
|
|
// Get the cartesian distances moved in XYZE
|
|
|
float difference[XYZE]; |
|
|
const float difference[XYZE] = { |
|
|
LOOP_XYZE(i) difference[i] = ltarget[i] - current_position[i]; |
|
|
ltarget[X_AXIS] - current_position[X_AXIS], |
|
|
|
|
|
ltarget[Y_AXIS] - current_position[Y_AXIS], |
|
|
|
|
|
ltarget[Z_AXIS] - current_position[Z_AXIS], |
|
|
|
|
|
ltarget[E_AXIS] - current_position[E_AXIS] |
|
|
|
|
|
}; |
|
|
|
|
|
|
|
|
// Get the linear distance in XYZ
|
|
|
// Get the linear distance in XYZ
|
|
|
float cartesian_mm = sqrt(sq(difference[X_AXIS]) + sq(difference[Y_AXIS]) + sq(difference[Z_AXIS])); |
|
|
float cartesian_mm = sqrt(sq(difference[X_AXIS]) + sq(difference[Y_AXIS]) + sq(difference[Z_AXIS])); |
|
|