|
|
|
@ -49,7 +49,6 @@
|
|
|
|
|
extern bool code_value_bool();
|
|
|
|
|
extern bool code_has_value();
|
|
|
|
|
extern float probe_pt(float x, float y, bool, int);
|
|
|
|
|
extern float zprobe_zoffset;
|
|
|
|
|
extern bool set_probe_deployed(bool);
|
|
|
|
|
#define DEPLOY_PROBE() set_probe_deployed(true)
|
|
|
|
|
#define STOW_PROBE() set_probe_deployed(false)
|
|
|
|
@ -516,9 +515,9 @@
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (code_seen('T')) {
|
|
|
|
|
float z1 = probe_pt(ubl_3_point_1_X, ubl_3_point_1_Y, false /*Stow Flag*/, g29_verbose_level) + zprobe_zoffset,
|
|
|
|
|
z2 = probe_pt(ubl_3_point_2_X, ubl_3_point_2_Y, false /*Stow Flag*/, g29_verbose_level) + zprobe_zoffset,
|
|
|
|
|
z3 = probe_pt(ubl_3_point_3_X, ubl_3_point_3_Y, true /*Stow Flag*/, g29_verbose_level) + zprobe_zoffset;
|
|
|
|
|
float z1 = probe_pt(ubl_3_point_1_X, ubl_3_point_1_Y, false /*Stow Flag*/, g29_verbose_level),
|
|
|
|
|
z2 = probe_pt(ubl_3_point_2_X, ubl_3_point_2_Y, false /*Stow Flag*/, g29_verbose_level),
|
|
|
|
|
z3 = probe_pt(ubl_3_point_3_X, ubl_3_point_3_Y, true /*Stow Flag*/, g29_verbose_level);
|
|
|
|
|
|
|
|
|
|
// We need to adjust z1, z2, z3 by the Mesh Height at these points. Just because they are non-zero doesn't mean
|
|
|
|
|
// the Mesh is tilted! (We need to compensate each probe point by what the Mesh says that location's height is)
|
|
|
|
@ -761,7 +760,7 @@
|
|
|
|
|
goto LEAVE;
|
|
|
|
|
}
|
|
|
|
|
const float measured_z = probe_pt(LOGICAL_X_POSITION(rawx), LOGICAL_Y_POSITION(rawy), stow_probe, g29_verbose_level);
|
|
|
|
|
ubl.z_values[location.x_index][location.y_index] = measured_z + zprobe_zoffset;
|
|
|
|
|
ubl.z_values[location.x_index][location.y_index] = measured_z;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (do_ubl_mesh_map) ubl.display_map(map_type);
|
|
|
|
|