preprocessor magic to have a single source principle
This commit is contained in:
parent
156763d027
commit
0b43761c3a
1 changed files with 27 additions and 74 deletions
|
@ -405,6 +405,29 @@ inline bool code_seen(char code)
|
||||||
strchr_pointer = strchr(cmdbuffer[bufindr], code);
|
strchr_pointer = strchr(cmdbuffer[bufindr], code);
|
||||||
return (strchr_pointer != NULL); //Return True if a character was found
|
return (strchr_pointer != NULL); //Return True if a character was found
|
||||||
}
|
}
|
||||||
|
#define HOMEAXIS(LETTER) \
|
||||||
|
if ((LETTER##_MIN_PIN > -1 && LETTER##_HOME_DIR==-1) || (LETTER##_MAX_PIN > -1 && LETTER##_HOME_DIR==1))\
|
||||||
|
{ \
|
||||||
|
current_position[LETTER##_AXIS] = 0; \
|
||||||
|
plan_set_position(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS]); \
|
||||||
|
destination[LETTER##_AXIS] = 1.5 * LETTER##_MAX_LENGTH * LETTER##_HOME_DIR; \
|
||||||
|
feedrate = homing_feedrate[LETTER##_AXIS]; \
|
||||||
|
prepare_move(); \
|
||||||
|
\
|
||||||
|
current_position[LETTER##_AXIS] = 0;\
|
||||||
|
plan_set_position(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS]);\
|
||||||
|
destination[LETTER##_AXIS] = -5 * LETTER##_HOME_DIR;\
|
||||||
|
prepare_move(); \
|
||||||
|
\
|
||||||
|
destination[LETTER##_AXIS] = 10 * LETTER##_HOME_DIR;\
|
||||||
|
feedrate = homing_feedrate[LETTER##_AXIS]/2 ; \
|
||||||
|
prepare_move(); \
|
||||||
|
\
|
||||||
|
current_position[LETTER##_AXIS] = (LETTER##_HOME_DIR == -1) ? 0 : LETTER##_MAX_LENGTH;\
|
||||||
|
plan_set_position(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS]);\
|
||||||
|
destination[LETTER##_AXIS] = current_position[LETTER##_AXIS];\
|
||||||
|
feedrate = 0.0;\
|
||||||
|
}
|
||||||
|
|
||||||
inline void process_commands()
|
inline void process_commands()
|
||||||
{
|
{
|
||||||
|
@ -455,85 +478,15 @@ inline void process_commands()
|
||||||
|
|
||||||
if((home_all_axis) || (code_seen(axis_codes[X_AXIS])))
|
if((home_all_axis) || (code_seen(axis_codes[X_AXIS])))
|
||||||
{
|
{
|
||||||
if ((X_MIN_PIN > -1 && X_HOME_DIR==-1) || (X_MAX_PIN > -1 && X_HOME_DIR==1)){
|
HOMEAXIS(X);
|
||||||
// st_synchronize();
|
|
||||||
current_position[X_AXIS] = 0;
|
|
||||||
plan_set_position(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS]);
|
|
||||||
destination[X_AXIS] = 1.5 * X_MAX_LENGTH * X_HOME_DIR;
|
|
||||||
feedrate = homing_feedrate[X_AXIS];
|
|
||||||
prepare_move();
|
|
||||||
|
|
||||||
// st_synchronize();
|
|
||||||
current_position[X_AXIS] = 0;
|
|
||||||
plan_set_position(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS]);
|
|
||||||
destination[X_AXIS] = -5 * X_HOME_DIR;
|
|
||||||
prepare_move();
|
|
||||||
|
|
||||||
// st_synchronize();
|
|
||||||
destination[X_AXIS] = 10 * X_HOME_DIR;
|
|
||||||
feedrate = homing_feedrate[X_AXIS]/2 ;
|
|
||||||
prepare_move();
|
|
||||||
|
|
||||||
// st_synchronize();
|
|
||||||
current_position[X_AXIS] = (X_HOME_DIR == -1) ? 0 : X_MAX_LENGTH;
|
|
||||||
plan_set_position(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS]);
|
|
||||||
destination[X_AXIS] = current_position[X_AXIS];
|
|
||||||
feedrate = 0.0;
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
|
||||||
if((home_all_axis) || (code_seen(axis_codes[Y_AXIS]))) {
|
if((home_all_axis) || (code_seen(axis_codes[Y_AXIS]))) {
|
||||||
if ((Y_MIN_PIN > -1 && Y_HOME_DIR==-1) || (Y_MAX_PIN > -1 && Y_HOME_DIR==1)){
|
HOMEAXIS(Y);
|
||||||
current_position[Y_AXIS] = 0;
|
|
||||||
plan_set_position(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS]);
|
|
||||||
destination[Y_AXIS] = 1.5 * Y_MAX_LENGTH * Y_HOME_DIR;
|
|
||||||
feedrate = homing_feedrate[Y_AXIS];
|
|
||||||
prepare_move();
|
|
||||||
// st_synchronize();
|
|
||||||
|
|
||||||
current_position[Y_AXIS] = 0;
|
|
||||||
plan_set_position(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS]);
|
|
||||||
destination[Y_AXIS] = -5 * Y_HOME_DIR;
|
|
||||||
prepare_move();
|
|
||||||
// st_synchronize();
|
|
||||||
|
|
||||||
destination[Y_AXIS] = 10 * Y_HOME_DIR;
|
|
||||||
feedrate = homing_feedrate[Y_AXIS]/2;
|
|
||||||
prepare_move();
|
|
||||||
// st_synchronize();
|
|
||||||
|
|
||||||
current_position[Y_AXIS] = (Y_HOME_DIR == -1) ? 0 : Y_MAX_LENGTH;
|
|
||||||
plan_set_position(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS]);
|
|
||||||
destination[Y_AXIS] = current_position[Y_AXIS];
|
|
||||||
feedrate = 0.0;
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
|
||||||
if((home_all_axis) || (code_seen(axis_codes[Z_AXIS]))) {
|
if((home_all_axis) || (code_seen(axis_codes[Z_AXIS]))) {
|
||||||
if ((Z_MIN_PIN > -1 && Z_HOME_DIR==-1) || (Z_MAX_PIN > -1 && Z_HOME_DIR==1)){
|
HOMEAXIS(Z);
|
||||||
current_position[Z_AXIS] = 0;
|
|
||||||
plan_set_position(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS]);
|
|
||||||
destination[Z_AXIS] = 1.5 * Z_MAX_LENGTH * Z_HOME_DIR;
|
|
||||||
feedrate = homing_feedrate[Z_AXIS];
|
|
||||||
prepare_move();
|
|
||||||
// st_synchronize();
|
|
||||||
|
|
||||||
current_position[Z_AXIS] = 0;
|
|
||||||
plan_set_position(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS]);
|
|
||||||
destination[Z_AXIS] = -2 * Z_HOME_DIR;
|
|
||||||
prepare_move();
|
|
||||||
// st_synchronize();
|
|
||||||
|
|
||||||
destination[Z_AXIS] = 3 * Z_HOME_DIR;
|
|
||||||
feedrate = homing_feedrate[Z_AXIS]/2;
|
|
||||||
prepare_move();
|
|
||||||
// st_synchronize();
|
|
||||||
|
|
||||||
current_position[Z_AXIS] = (Z_HOME_DIR == -1) ? 0 : Z_MAX_LENGTH;
|
|
||||||
plan_set_position(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS]);
|
|
||||||
destination[Z_AXIS] = current_position[Z_AXIS];
|
|
||||||
feedrate = 0.0;
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
feedrate = saved_feedrate;
|
feedrate = saved_feedrate;
|
||||||
feedmultiply = saved_feedmultiply;
|
feedmultiply = saved_feedmultiply;
|
||||||
|
@ -684,7 +637,7 @@ inline void process_commands()
|
||||||
Serial.println();
|
Serial.println();
|
||||||
#endif //TEMP_1_PIN
|
#endif //TEMP_1_PIN
|
||||||
#else
|
#else
|
||||||
Serial.println("echo: No thermistors - no temp");
|
SERIAL_ERRORLN("No thermistors - no temp");
|
||||||
#endif
|
#endif
|
||||||
return;
|
return;
|
||||||
break;
|
break;
|
||||||
|
|
Reference in a new issue