z-probe offset fix (PR#2361)

verified via 1.0.2 tag that compiles by multiple people,
credit for the fix goes to paulusjacobus for the initial find and
sniffle for the correction so M851 works.
This commit is contained in:
Todd Swindoll 2015-06-30 19:33:46 -05:00 committed by Richard Wackerbarth
parent dae4eb36ad
commit a111fbbd0a

View File

@ -2835,7 +2835,8 @@ inline void gcode_G28() {
real_z = (float)st_get_position(Z_AXIS) / axis_steps_per_unit[Z_AXIS]; //get the real Z (since the auto bed leveling is already correcting the plane) real_z = (float)st_get_position(Z_AXIS) / axis_steps_per_unit[Z_AXIS]; //get the real Z (since the auto bed leveling is already correcting the plane)
apply_rotation_xyz(plan_bed_level_matrix, x_tmp, y_tmp, z_tmp); // Apply the correction sending the probe offset apply_rotation_xyz(plan_bed_level_matrix, x_tmp, y_tmp, z_tmp); // Apply the correction sending the probe offset
current_position[Z_AXIS] += z_tmp - real_z; // The difference is added to current position and sent to planner. //line below controls z probe offset, zprobe_zoffset is the actual offset that can be modified via m851
current_position[Z_AXIS] = z_tmp - real_z + zprobe_zoffset; // The difference is added to current position and sent to planner.
sync_plan_position(); sync_plan_position();
} }
#endif // !DELTA #endif // !DELTA