Correct XYZ after obtaining plan_bed_level_matrix
The current position needs to be updated by using the inverse `plan_bed_level_matrix` on X, Y, and Z. All moves in the planner are transformed by the `plan_bed_level_matrix` from this point forward.
This commit is contained in:
parent
5f6962dd90
commit
97a69d9b1c
@ -1055,7 +1055,7 @@ inline void sync_plan_position() {
|
|||||||
//corrected_position.debug("position after");
|
//corrected_position.debug("position after");
|
||||||
current_position[X_AXIS] = corrected_position.x;
|
current_position[X_AXIS] = corrected_position.x;
|
||||||
current_position[Y_AXIS] = corrected_position.y;
|
current_position[Y_AXIS] = corrected_position.y;
|
||||||
current_position[Z_AXIS] = zprobe_zoffset; // was: corrected_position.z
|
current_position[Z_AXIS] = corrected_position.z;
|
||||||
|
|
||||||
sync_plan_position();
|
sync_plan_position();
|
||||||
}
|
}
|
||||||
@ -1084,7 +1084,7 @@ inline void sync_plan_position() {
|
|||||||
vector_3 corrected_position = plan_get_position();
|
vector_3 corrected_position = plan_get_position();
|
||||||
current_position[X_AXIS] = corrected_position.x;
|
current_position[X_AXIS] = corrected_position.x;
|
||||||
current_position[Y_AXIS] = corrected_position.y;
|
current_position[Y_AXIS] = corrected_position.y;
|
||||||
current_position[Z_AXIS] = zprobe_zoffset; // was: corrected_position.z
|
current_position[Z_AXIS] = corrected_position.z;
|
||||||
|
|
||||||
sync_plan_position();
|
sync_plan_position();
|
||||||
}
|
}
|
||||||
|
Loading…
Reference in New Issue
Block a user