HOMEAXIS: make into a function
Replace the large macro HOMEAXIS with a function. This avoids the compiler generating three copies of largely identical code. The saving is 724 bytes of program memory. We make use of XYZ_CONSTS_FROM_CONFIG to provide convenient array-shaped access to MAX_LENGTH, HOME_RETRACT_MM and HOME_DIR. Signed-off-by: Ian Jackson <ijackson@chiark.greenend.org.uk>
This commit is contained in:
		@@ -557,6 +557,7 @@ bool code_seen(char code)
 | 
				
			|||||||
	{ return pgm_read_##reader##_near(p); }
 | 
						{ return pgm_read_##reader##_near(p); }
 | 
				
			||||||
 | 
					
 | 
				
			||||||
DEFINE_PGM_READ_ANY(float,       float);
 | 
					DEFINE_PGM_READ_ANY(float,       float);
 | 
				
			||||||
 | 
					DEFINE_PGM_READ_ANY(signed char, byte);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
#define XYZ_CONSTS_FROM_CONFIG(type, array, CONFIG)	\
 | 
					#define XYZ_CONSTS_FROM_CONFIG(type, array, CONFIG)	\
 | 
				
			||||||
static const PROGMEM type array##_P[3] =		\
 | 
					static const PROGMEM type array##_P[3] =		\
 | 
				
			||||||
@@ -567,6 +568,9 @@ static inline type array(int axis)			\
 | 
				
			|||||||
XYZ_CONSTS_FROM_CONFIG(float, base_min_pos,    MIN_POS);
 | 
					XYZ_CONSTS_FROM_CONFIG(float, base_min_pos,    MIN_POS);
 | 
				
			||||||
XYZ_CONSTS_FROM_CONFIG(float, base_max_pos,    MAX_POS);
 | 
					XYZ_CONSTS_FROM_CONFIG(float, base_max_pos,    MAX_POS);
 | 
				
			||||||
XYZ_CONSTS_FROM_CONFIG(float, base_home_pos,   HOME_POS);
 | 
					XYZ_CONSTS_FROM_CONFIG(float, base_home_pos,   HOME_POS);
 | 
				
			||||||
 | 
					XYZ_CONSTS_FROM_CONFIG(float, max_length,      MAX_LENGTH);
 | 
				
			||||||
 | 
					XYZ_CONSTS_FROM_CONFIG(float, home_retract_mm, HOME_RETRACT_MM);
 | 
				
			||||||
 | 
					XYZ_CONSTS_FROM_CONFIG(signed char, home_dir,  HOME_DIR);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
static void axis_is_at_home(int axis) {
 | 
					static void axis_is_at_home(int axis) {
 | 
				
			||||||
  current_position[axis] = base_home_pos(axis) + add_homeing[axis];
 | 
					  current_position[axis] = base_home_pos(axis) + add_homeing[axis];
 | 
				
			||||||
@@ -574,32 +578,39 @@ static void axis_is_at_home(int axis) {
 | 
				
			|||||||
  max_pos[axis] =          base_max_pos(axis) + add_homeing[axis];
 | 
					  max_pos[axis] =          base_max_pos(axis) + add_homeing[axis];
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
#define HOMEAXIS(LETTER) \
 | 
					static void homeaxis(int axis) {
 | 
				
			||||||
  if ((LETTER##_MIN_PIN > -1 && LETTER##_HOME_DIR==-1) || (LETTER##_MAX_PIN > -1 && LETTER##_HOME_DIR==1))\
 | 
					#define HOMEAXIS_DO(LETTER) \
 | 
				
			||||||
    { \
 | 
					  ((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]); \
 | 
					  if (axis==X_AXIS ? HOMEAXIS_DO(X) :
 | 
				
			||||||
    destination[LETTER##_AXIS] = 1.5 * LETTER##_MAX_LENGTH * LETTER##_HOME_DIR; \
 | 
					      axis==Y_AXIS ? HOMEAXIS_DO(Y) :
 | 
				
			||||||
    feedrate = homing_feedrate[LETTER##_AXIS]; \
 | 
					      axis==Z_AXIS ? HOMEAXIS_DO(Z) :
 | 
				
			||||||
    plan_buffer_line(destination[X_AXIS], destination[Y_AXIS], destination[Z_AXIS], destination[E_AXIS], feedrate/60, active_extruder); \
 | 
					      0) {
 | 
				
			||||||
    st_synchronize();\
 | 
					    current_position[axis] = 0;
 | 
				
			||||||
    \
 | 
					    plan_set_position(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS]);
 | 
				
			||||||
    current_position[LETTER##_AXIS] = 0;\
 | 
					    destination[axis] = 1.5 * max_length(axis) * home_dir(axis);
 | 
				
			||||||
    plan_set_position(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS]);\
 | 
					    feedrate = homing_feedrate[axis];
 | 
				
			||||||
    destination[LETTER##_AXIS] = -LETTER##_HOME_RETRACT_MM * LETTER##_HOME_DIR;\
 | 
					    plan_buffer_line(destination[X_AXIS], destination[Y_AXIS], destination[Z_AXIS], destination[E_AXIS], feedrate/60, active_extruder);
 | 
				
			||||||
    plan_buffer_line(destination[X_AXIS], destination[Y_AXIS], destination[Z_AXIS], destination[E_AXIS], feedrate/60, active_extruder); \
 | 
					    st_synchronize();
 | 
				
			||||||
    st_synchronize();\
 | 
					   
 | 
				
			||||||
    \
 | 
					    current_position[axis] = 0;
 | 
				
			||||||
    destination[LETTER##_AXIS] = 2*LETTER##_HOME_RETRACT_MM * LETTER##_HOME_DIR;\
 | 
					    plan_set_position(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS]);
 | 
				
			||||||
    feedrate = homing_feedrate[LETTER##_AXIS]/2 ;  \
 | 
					    destination[axis] = -home_retract_mm(axis) * home_dir(axis);
 | 
				
			||||||
    plan_buffer_line(destination[X_AXIS], destination[Y_AXIS], destination[Z_AXIS], destination[E_AXIS], feedrate/60, active_extruder); \
 | 
					    plan_buffer_line(destination[X_AXIS], destination[Y_AXIS], destination[Z_AXIS], destination[E_AXIS], feedrate/60, active_extruder);
 | 
				
			||||||
    st_synchronize();\
 | 
					    st_synchronize();
 | 
				
			||||||
    \
 | 
					   
 | 
				
			||||||
    axis_is_at_home(LETTER##_AXIS);					\
 | 
					    destination[axis] = 2*home_retract_mm(axis) * home_dir(axis);
 | 
				
			||||||
    destination[LETTER##_AXIS] = current_position[LETTER##_AXIS]; \
 | 
					    feedrate = homing_feedrate[axis]/2 ; 
 | 
				
			||||||
    feedrate = 0.0;\
 | 
					    plan_buffer_line(destination[X_AXIS], destination[Y_AXIS], destination[Z_AXIS], destination[E_AXIS], feedrate/60, active_extruder);
 | 
				
			||||||
    endstops_hit_on_purpose();\
 | 
					    st_synchronize();
 | 
				
			||||||
 | 
					   
 | 
				
			||||||
 | 
					    axis_is_at_home(axis);					
 | 
				
			||||||
 | 
					    destination[axis] = current_position[axis];
 | 
				
			||||||
 | 
					    feedrate = 0.0;
 | 
				
			||||||
 | 
					    endstops_hit_on_purpose();
 | 
				
			||||||
  }
 | 
					  }
 | 
				
			||||||
 | 
					}
 | 
				
			||||||
 | 
					#define HOMEAXIS(LETTER) homeaxis(LETTER##_AXIS)
 | 
				
			||||||
 | 
					
 | 
				
			||||||
void process_commands()
 | 
					void process_commands()
 | 
				
			||||||
{
 | 
					{
 | 
				
			||||||
 
 | 
				
			|||||||
		Reference in New Issue
	
	Block a user