|
@ -10592,12 +10592,25 @@ void ok_to_send() { |
|
|
const float x = RAW_X_POSITION(logical[X_AXIS]) - bilinear_start[X_AXIS], |
|
|
const float x = RAW_X_POSITION(logical[X_AXIS]) - bilinear_start[X_AXIS], |
|
|
y = RAW_Y_POSITION(logical[Y_AXIS]) - bilinear_start[Y_AXIS]; |
|
|
y = RAW_Y_POSITION(logical[Y_AXIS]) - bilinear_start[Y_AXIS]; |
|
|
|
|
|
|
|
|
|
|
|
#if ENABLED(EXTRAPOLATE_BEYOND_GRID) |
|
|
|
|
|
// Keep using the last grid box
|
|
|
|
|
|
#define FAR_EDGE_OR_BOX 2 |
|
|
|
|
|
#else |
|
|
|
|
|
// Just use the grid far edge
|
|
|
|
|
|
#define FAR_EDGE_OR_BOX 1 |
|
|
|
|
|
#endif |
|
|
|
|
|
|
|
|
if (last_x != x) { |
|
|
if (last_x != x) { |
|
|
last_x = x; |
|
|
last_x = x; |
|
|
ratio_x = x * ABL_BG_FACTOR(X_AXIS); |
|
|
ratio_x = x * ABL_BG_FACTOR(X_AXIS); |
|
|
const float gx = constrain(floor(ratio_x), 0, ABL_BG_POINTS_X - 1); |
|
|
const float gx = constrain(floor(ratio_x), 0, ABL_BG_POINTS_X - FAR_EDGE_OR_BOX); |
|
|
ratio_x -= gx; // Subtract whole to get the ratio within the grid box
|
|
|
ratio_x -= gx; // Subtract whole to get the ratio within the grid box
|
|
|
NOLESS(ratio_x, 0); // Never < 0.0. (> 1.0 is ok when nextx==gridx.)
|
|
|
|
|
|
|
|
|
#if DISABLED(EXTRAPOLATE_BEYOND_GRID) |
|
|
|
|
|
// Beyond the grid maintain height at grid edges
|
|
|
|
|
|
NOLESS(ratio_x, 0); // Never < 0.0. (> 1.0 is ok when nextx==gridx.)
|
|
|
|
|
|
#endif |
|
|
|
|
|
|
|
|
gridx = gx; |
|
|
gridx = gx; |
|
|
nextx = min(gridx + 1, ABL_BG_POINTS_X - 1); |
|
|
nextx = min(gridx + 1, ABL_BG_POINTS_X - 1); |
|
|
} |
|
|
} |
|
@ -10607,9 +10620,14 @@ void ok_to_send() { |
|
|
if (last_y != y) { |
|
|
if (last_y != y) { |
|
|
last_y = y; |
|
|
last_y = y; |
|
|
ratio_y = y * ABL_BG_FACTOR(Y_AXIS); |
|
|
ratio_y = y * ABL_BG_FACTOR(Y_AXIS); |
|
|
const float gy = constrain(floor(ratio_y), 0, ABL_BG_POINTS_Y - 1); |
|
|
const float gy = constrain(floor(ratio_y), 0, ABL_BG_POINTS_Y - FAR_EDGE_OR_BOX); |
|
|
ratio_y -= gy; |
|
|
ratio_y -= gy; |
|
|
NOLESS(ratio_y, 0); |
|
|
|
|
|
|
|
|
#if DISABLED(EXTRAPOLATE_BEYOND_GRID) |
|
|
|
|
|
// Beyond the grid maintain height at grid edges
|
|
|
|
|
|
NOLESS(ratio_y, 0); // Never < 0.0. (> 1.0 is ok when nexty==gridy.)
|
|
|
|
|
|
#endif |
|
|
|
|
|
|
|
|
gridy = gy; |
|
|
gridy = gy; |
|
|
nexty = min(gridy + 1, ABL_BG_POINTS_Y - 1); |
|
|
nexty = min(gridy + 1, ABL_BG_POINTS_Y - 1); |
|
|
} |
|
|
} |
|
|