|
@@ -534,10 +534,10 @@ void Planner::check_axes_activity() {
|
534
|
534
|
if (!ubl.state.active) return;
|
535
|
535
|
#if ENABLED(ENABLE_LEVELING_FADE_HEIGHT)
|
536
|
536
|
// if z_fade_height enabled (nonzero) and raw_z above it, no leveling required
|
537
|
|
- if ((planner.z_fade_height) && (planner.z_fade_height <= RAW_Z_POSITION(lz))) return;
|
|
537
|
+ if (planner.z_fade_height && planner.z_fade_height <= RAW_Z_POSITION(lz)) return;
|
538
|
538
|
lz += ubl.state.z_offset + ubl.get_z_correction(lx, ly) * ubl.fade_scaling_factor_for_z(lz);
|
539
|
539
|
#else // no fade
|
540
|
|
- lz += ubl.state.z_offset + ubl.get_z_correction(lx,ly);
|
|
540
|
+ lz += ubl.state.z_offset + ubl.get_z_correction(lx, ly);
|
541
|
541
|
#endif // FADE
|
542
|
542
|
#endif // UBL
|
543
|
543
|
|
|
@@ -598,10 +598,10 @@ void Planner::check_axes_activity() {
|
598
|
598
|
|
599
|
599
|
if (ubl.state.active) {
|
600
|
600
|
|
601
|
|
- const float z_physical = RAW_Z_POSITION(logical[Z_AXIS]);
|
602
|
|
- const float z_ublmesh = ubl.get_z_correction(logical[X_AXIS], logical[Y_AXIS]);
|
603
|
|
- const float z_virtual = z_physical - ubl.state.z_offset - z_ublmesh;
|
604
|
|
- float z_logical = LOGICAL_Z_POSITION(z_virtual);
|
|
601
|
+ const float z_physical = RAW_Z_POSITION(logical[Z_AXIS]),
|
|
602
|
+ z_correct = ubl.get_z_correction(logical[X_AXIS], logical[Y_AXIS]),
|
|
603
|
+ z_virtual = z_physical - ubl.state.z_offset - z_correct;
|
|
604
|
+ float z_logical = LOGICAL_Z_POSITION(z_virtual);
|
605
|
605
|
|
606
|
606
|
#if ENABLED(ENABLE_LEVELING_FADE_HEIGHT)
|
607
|
607
|
|
|
@@ -614,10 +614,10 @@ void Planner::check_axes_activity() {
|
614
|
614
|
// so L=(P-O-M)/(1-M/H) for L<H
|
615
|
615
|
|
616
|
616
|
if (planner.z_fade_height) {
|
617
|
|
- if (z_logical < planner.z_fade_height )
|
618
|
|
- z_logical = z_logical / (1.0 - (z_ublmesh * planner.inverse_z_fade_height));
|
619
|
617
|
if (z_logical >= planner.z_fade_height)
|
620
|
618
|
z_logical = LOGICAL_Z_POSITION(z_physical - ubl.state.z_offset);
|
|
619
|
+ else
|
|
620
|
+ z_logical /= 1.0 - z_correct * planner.inverse_z_fade_height;
|
621
|
621
|
}
|
622
|
622
|
|
623
|
623
|
#endif // ENABLE_LEVELING_FADE_HEIGHT
|