preprocessor magic to have a single source principle
This commit is contained in:
		| @@ -405,6 +405,29 @@ inline bool code_seen(char code) | ||||
|   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() | ||||
| { | ||||
| @@ -455,85 +478,15 @@ 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; | ||||
| @@ -684,7 +637,7 @@ inline void process_commands() | ||||
|             Serial.println(); | ||||
|           #endif //TEMP_1_PIN | ||||
|         #else | ||||
|           Serial.println("echo: No thermistors - no temp"); | ||||
|           SERIAL_ERRORLN("No thermistors - no temp"); | ||||
|       #endif | ||||
|       return; | ||||
|       break; | ||||
|   | ||||
		Reference in New Issue
	
	Block a user