strchr_pointer = strchr(cmdbuffer[bufindr], code);
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()
{
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)){
-// 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;
- }
+ HOMEAXIS(X);
}
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)){
- 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;
- }
+ HOMEAXIS(Y);
}
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)){
- 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;
- }
+ HOMEAXIS(Z);
}
feedrate = saved_feedrate;
feedmultiply = saved_feedmultiply;
Serial.println();
#endif //TEMP_1_PIN
#else
- Serial.println("echo: No thermistors - no temp");
+ SERIAL_ERRORLN("No thermistors - no temp");
#endif
return;
break;