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:
Scott Lahteine 2015-03-31 04:24:13 -07:00
parent 5f6962dd90
commit 97a69d9b1c

View file

@ -1055,7 +1055,7 @@ inline void sync_plan_position() {
//corrected_position.debug("position after");
current_position[X_AXIS] = corrected_position.x;
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();
}
@ -1084,7 +1084,7 @@ inline void sync_plan_position() {
vector_3 corrected_position = plan_get_position();
current_position[X_AXIS] = corrected_position.x;
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();
}