3DPrinting/Prusa-Firmware
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Merge pull request #95 from PavelSindler/selftest_fix

Browse Source 
selftest for axis modified to overcome collision between cables and PSU cover
This commit is contained in:
XPila 2017-11-22 02:58:46 +01:00 committed by GitHub
commit ee9936fa6c
No known key found for this signature in database
GPG Key ID: 4AEE18F83AFDEB23
1 changed files with 13 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

15
Firmware/ultralcd.cpp
View File

@ -5455,17 +5455,28 @@ static bool lcd_selfcheck_axis_sg(char axis) {
float axis_length, current_position_init, current_position_final; float axis_length, current_position_init, current_position_final;
float measured_axis_length[2]; float measured_axis_length[2];
float margin = 60; float margin = 60;
float max_error_mm = 10; float max_error_mm = 5;
switch (axis) { switch (axis) {
case 0: axis_length = X_MAX_POS; break; case 0: axis_length = X_MAX_POS; break;
case 1: axis_length = Y_MAX_POS + 8; break; case 1: axis_length = Y_MAX_POS + 8; break;
default: axis_length = 210; break; default: axis_length = 210; break;
} }
tmc2130_sg_stop_on_crash = false; tmc2130_sg_stop_on_crash = false;
tmc2130_home_exit(); tmc2130_home_exit();
enable_endstops(true); enable_endstops(true);
if (axis == X_AXIS) { //there is collision between cables and PSU cover in X axis if Z coordinate is too low
current_position[Z_AXIS] += 17;
plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[3], manual_feedrate[0] / 60, active_extruder);
tmc2130_home_enter(Z_AXIS_MASK);
st_synchronize();
tmc2130_home_exit();
}
// first axis length measurement begin // first axis length measurement begin
tmc2130_home_enter(X_AXIS_MASK << axis); tmc2130_home_enter(X_AXIS_MASK << axis);
current_position[axis] -= (axis_length + margin); current_position[axis] -= (axis_length + margin);