|
|
@ -238,7 +238,7 @@ static char *strchr_pointer; ///< A pointer to find chars in the command string
|
|
|
|
const char* queued_commands_P= NULL; /* pointer to the current line in the active sequence of commands, or NULL when none */
|
|
|
|
const char* queued_commands_P= NULL; /* pointer to the current line in the active sequence of commands, or NULL when none */
|
|
|
|
const int sensitive_pins[] = SENSITIVE_PINS; ///< Sensitive pin list for M42
|
|
|
|
const int sensitive_pins[] = SENSITIVE_PINS; ///< Sensitive pin list for M42
|
|
|
|
// Inactivity shutdown
|
|
|
|
// Inactivity shutdown
|
|
|
|
static unsigned long previous_millis_cmd = 0;
|
|
|
|
unsigned long previous_millis_cmd = 0;
|
|
|
|
static unsigned long max_inactive_time = 0;
|
|
|
|
static unsigned long max_inactive_time = 0;
|
|
|
|
static unsigned long stepper_inactive_time = DEFAULT_STEPPER_DEACTIVE_TIME*1000l;
|
|
|
|
static unsigned long stepper_inactive_time = DEFAULT_STEPPER_DEACTIVE_TIME*1000l;
|
|
|
|
unsigned long starttime = 0; ///< Print job start time
|
|
|
|
unsigned long starttime = 0; ///< Print job start time
|
|
|
@ -986,8 +986,6 @@ static void axis_is_at_home(int axis) {
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
inline void refresh_cmd_timeout() { previous_millis_cmd = millis(); }
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
/**
|
|
|
|
* Some planner shorthand inline functions
|
|
|
|
* Some planner shorthand inline functions
|
|
|
|
*/
|
|
|
|
*/
|
|
|
@ -1328,19 +1326,19 @@ inline void set_destination_to_current() { memcpy(destination, current_position,
|
|
|
|
|
|
|
|
|
|
|
|
enum ProbeAction {
|
|
|
|
enum ProbeAction {
|
|
|
|
ProbeStay = 0,
|
|
|
|
ProbeStay = 0,
|
|
|
|
ProbeEngage = BIT(0),
|
|
|
|
ProbeDeploy = BIT(0),
|
|
|
|
ProbeRetract = BIT(1),
|
|
|
|
ProbeStow = BIT(1),
|
|
|
|
ProbeEngageAndRetract = (ProbeEngage | ProbeRetract)
|
|
|
|
ProbeDeployAndStow = (ProbeDeploy | ProbeStow)
|
|
|
|
};
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
|
|
// Probe bed height at position (x,y), returns the measured z value
|
|
|
|
// Probe bed height at position (x,y), returns the measured z value
|
|
|
|
static float probe_pt(float x, float y, float z_before, ProbeAction retract_action=ProbeEngageAndRetract, int verbose_level=1) {
|
|
|
|
static float probe_pt(float x, float y, float z_before, ProbeAction retract_action=ProbeDeployAndStow, int verbose_level=1) {
|
|
|
|
// move to right place
|
|
|
|
// move to right place
|
|
|
|
do_blocking_move_to(current_position[X_AXIS], current_position[Y_AXIS], z_before);
|
|
|
|
do_blocking_move_to(current_position[X_AXIS], current_position[Y_AXIS], z_before);
|
|
|
|
do_blocking_move_to(x - X_PROBE_OFFSET_FROM_EXTRUDER, y - Y_PROBE_OFFSET_FROM_EXTRUDER, current_position[Z_AXIS]);
|
|
|
|
do_blocking_move_to(x - X_PROBE_OFFSET_FROM_EXTRUDER, y - Y_PROBE_OFFSET_FROM_EXTRUDER, current_position[Z_AXIS]);
|
|
|
|
|
|
|
|
|
|
|
|
#if !defined(Z_PROBE_SLED) && !defined(Z_PROBE_ALLEN_KEY)
|
|
|
|
#if !defined(Z_PROBE_SLED) && !defined(Z_PROBE_ALLEN_KEY)
|
|
|
|
if (retract_action & ProbeEngage) deploy_z_probe();
|
|
|
|
if (retract_action & ProbeDeploy) deploy_z_probe();
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
run_z_probe();
|
|
|
|
run_z_probe();
|
|
|
@ -1354,7 +1352,7 @@ inline void set_destination_to_current() { memcpy(destination, current_position,
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
#if !defined(Z_PROBE_SLED) && !defined(Z_PROBE_ALLEN_KEY)
|
|
|
|
#if !defined(Z_PROBE_SLED) && !defined(Z_PROBE_ALLEN_KEY)
|
|
|
|
if (retract_action & ProbeRetract) stow_z_probe();
|
|
|
|
if (retract_action & ProbeStow) stow_z_probe();
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
if (verbose_level > 2) {
|
|
|
|
if (verbose_level > 2) {
|
|
|
@ -2167,7 +2165,7 @@ inline void gcode_G28() {
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
bool dryrun = code_seen('D') || code_seen('d'),
|
|
|
|
bool dryrun = code_seen('D') || code_seen('d'),
|
|
|
|
engage_probe_for_each_reading = code_seen('E') || code_seen('e');
|
|
|
|
deploy_probe_for_each_reading = code_seen('E') || code_seen('e');
|
|
|
|
|
|
|
|
|
|
|
|
#ifdef AUTO_BED_LEVELING_GRID
|
|
|
|
#ifdef AUTO_BED_LEVELING_GRID
|
|
|
|
|
|
|
|
|
|
|
@ -2319,14 +2317,13 @@ inline void gcode_G28() {
|
|
|
|
if (distance_from_center > DELTA_PROBABLE_RADIUS) continue;
|
|
|
|
if (distance_from_center > DELTA_PROBABLE_RADIUS) continue;
|
|
|
|
#endif //DELTA
|
|
|
|
#endif //DELTA
|
|
|
|
|
|
|
|
|
|
|
|
// Enhanced G29 - Do not retract servo between probes
|
|
|
|
|
|
|
|
ProbeAction act;
|
|
|
|
ProbeAction act;
|
|
|
|
if (engage_probe_for_each_reading)
|
|
|
|
if (deploy_probe_for_each_reading) // G29 E - Stow between probes
|
|
|
|
act = ProbeEngageAndRetract;
|
|
|
|
act = ProbeDeployAndStow;
|
|
|
|
else if (yProbe == front_probe_bed_position && xCount == 0)
|
|
|
|
else if (yCount == 0 && xCount == 0)
|
|
|
|
act = ProbeEngage;
|
|
|
|
act = ProbeDeploy;
|
|
|
|
else if (yProbe == front_probe_bed_position + (yGridSpacing * (auto_bed_leveling_grid_points - 1)) && xCount == auto_bed_leveling_grid_points - 1)
|
|
|
|
else if (yCount == auto_bed_leveling_grid_points - 1 && xCount == auto_bed_leveling_grid_points - 1)
|
|
|
|
act = ProbeRetract;
|
|
|
|
act = ProbeStow;
|
|
|
|
else
|
|
|
|
else
|
|
|
|
act = ProbeStay;
|
|
|
|
act = ProbeStay;
|
|
|
|
|
|
|
|
|
|
|
@ -2417,10 +2414,10 @@ inline void gcode_G28() {
|
|
|
|
|
|
|
|
|
|
|
|
// Actions for each probe
|
|
|
|
// Actions for each probe
|
|
|
|
ProbeAction p1, p2, p3;
|
|
|
|
ProbeAction p1, p2, p3;
|
|
|
|
if (engage_probe_for_each_reading)
|
|
|
|
if (deploy_probe_for_each_reading)
|
|
|
|
p1 = p2 = p3 = ProbeEngageAndRetract;
|
|
|
|
p1 = p2 = p3 = ProbeDeployAndStow;
|
|
|
|
else
|
|
|
|
else
|
|
|
|
p1 = ProbeEngage, p2 = ProbeStay, p3 = ProbeRetract;
|
|
|
|
p1 = ProbeDeploy, p2 = ProbeStay, p3 = ProbeStow;
|
|
|
|
|
|
|
|
|
|
|
|
// Probe at 3 arbitrary points
|
|
|
|
// Probe at 3 arbitrary points
|
|
|
|
float z_at_pt_1 = probe_pt(ABL_PROBE_PT_1_X, ABL_PROBE_PT_1_Y, Z_RAISE_BEFORE_PROBING, p1, verbose_level),
|
|
|
|
float z_at_pt_1 = probe_pt(ABL_PROBE_PT_1_X, ABL_PROBE_PT_1_Y, Z_RAISE_BEFORE_PROBING, p1, verbose_level),
|
|
|
@ -2839,7 +2836,7 @@ inline void gcode_M42() {
|
|
|
|
Z_start_location = Z_current + Z_RAISE_BEFORE_PROBING,
|
|
|
|
Z_start_location = Z_current + Z_RAISE_BEFORE_PROBING,
|
|
|
|
ext_position = st_get_position_mm(E_AXIS);
|
|
|
|
ext_position = st_get_position_mm(E_AXIS);
|
|
|
|
|
|
|
|
|
|
|
|
bool engage_probe_for_each_reading = code_seen('E') || code_seen('e');
|
|
|
|
bool deploy_probe_for_each_reading = code_seen('E') || code_seen('e');
|
|
|
|
|
|
|
|
|
|
|
|
if (code_seen('X') || code_seen('x')) {
|
|
|
|
if (code_seen('X') || code_seen('x')) {
|
|
|
|
X_probe_location = code_value() - X_PROBE_OFFSET_FROM_EXTRUDER;
|
|
|
|
X_probe_location = code_value() - X_PROBE_OFFSET_FROM_EXTRUDER;
|
|
|
@ -2917,7 +2914,7 @@ inline void gcode_M42() {
|
|
|
|
st_synchronize();
|
|
|
|
st_synchronize();
|
|
|
|
current_position[Z_AXIS] = Z_current = st_get_position_mm(Z_AXIS);
|
|
|
|
current_position[Z_AXIS] = Z_current = st_get_position_mm(Z_AXIS);
|
|
|
|
|
|
|
|
|
|
|
|
if (engage_probe_for_each_reading) stow_z_probe();
|
|
|
|
if (deploy_probe_for_each_reading) stow_z_probe();
|
|
|
|
|
|
|
|
|
|
|
|
for (uint16_t n=0; n < n_samples; n++) {
|
|
|
|
for (uint16_t n=0; n < n_samples; n++) {
|
|
|
|
|
|
|
|
|
|
|
@ -2959,7 +2956,7 @@ inline void gcode_M42() {
|
|
|
|
|
|
|
|
|
|
|
|
} // n_legs
|
|
|
|
} // n_legs
|
|
|
|
|
|
|
|
|
|
|
|
if (engage_probe_for_each_reading) {
|
|
|
|
if (deploy_probe_for_each_reading) {
|
|
|
|
deploy_z_probe();
|
|
|
|
deploy_z_probe();
|
|
|
|
delay(1000);
|
|
|
|
delay(1000);
|
|
|
|
}
|
|
|
|
}
|
|
|
@ -3006,13 +3003,13 @@ inline void gcode_M42() {
|
|
|
|
plan_buffer_line(X_probe_location, Y_probe_location, Z_start_location, current_position[E_AXIS], homing_feedrate[Z_AXIS]/60, active_extruder);
|
|
|
|
plan_buffer_line(X_probe_location, Y_probe_location, Z_start_location, current_position[E_AXIS], homing_feedrate[Z_AXIS]/60, active_extruder);
|
|
|
|
st_synchronize();
|
|
|
|
st_synchronize();
|
|
|
|
|
|
|
|
|
|
|
|
if (engage_probe_for_each_reading) {
|
|
|
|
if (deploy_probe_for_each_reading) {
|
|
|
|
stow_z_probe();
|
|
|
|
stow_z_probe();
|
|
|
|
delay(1000);
|
|
|
|
delay(1000);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
if (!engage_probe_for_each_reading) {
|
|
|
|
if (!deploy_probe_for_each_reading) {
|
|
|
|
stow_z_probe();
|
|
|
|
stow_z_probe();
|
|
|
|
delay(1000);
|
|
|
|
delay(1000);
|
|
|
|
}
|
|
|
|
}
|
|
|
|