| 
															
																@@ -263,6 +263,7 @@ float HotendTempBckp = 0; 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 int fanSpeedBckp = 0; 
															 | 
															
															 | 
															
																 int fanSpeedBckp = 0; 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 float pause_lastpos[4]; 
															 | 
															
															 | 
															
																 float pause_lastpos[4]; 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 unsigned long pause_time = 0; 
															 | 
															
															 | 
															
																 unsigned long pause_time = 0; 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 
															 | 
															
															 | 
															
																+unsigned long start_pause_print = millis(); 
															 | 
														
													
												
													
														
															| 
															 | 
															
																  
															 | 
															
															 | 
															
																  
															 | 
														
													
												
													
														
															| 
															 | 
															
																 bool mesh_bed_leveling_flag = false; 
															 | 
															
															 | 
															
																 bool mesh_bed_leveling_flag = false; 
															 | 
														
													
												
													
														
															| 
															 | 
															
																  
															 | 
															
															 | 
															
																  
															 | 
														
													
												
											
												
													
														
															 | 
															
																@@ -2791,6 +2792,17 @@ void process_commands() 
															 | 
														
													
												
													
														
															| 
															 | 
															
																         } 
															 | 
															
															 | 
															
																         } 
															 | 
														
													
												
													
														
															| 
															 | 
															
																         break; 
															 | 
															
															 | 
															
																         break; 
															 | 
														
													
												
													
														
															| 
															 | 
															
																  
															 | 
															
															 | 
															
																  
															 | 
														
													
												
													
														
															| 
															 | 
															
																 
															 | 
															
															 | 
															
																+ 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 
															 | 
															
															 | 
															
																+	case 75: 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 
															 | 
															
															 | 
															
																+	{ 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 
															 | 
															
															 | 
															
																+		for (int i = 40; i <= 110; i++) { 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 
															 | 
															
															 | 
															
																+			MYSERIAL.print(i); 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 
															 | 
															
															 | 
															
																+			MYSERIAL.print("  "); 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 
															 | 
															
															 | 
															
																+			MYSERIAL.println(temp_comp_interpolation(i));// / axis_steps_per_unit[Z_AXIS]); 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 
															 | 
															
															 | 
															
																+		} 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 
															 | 
															
															 | 
															
																+	} 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 
															 | 
															
															 | 
															
																+	break; 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 
															 | 
															
															 | 
															
																+ 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 	case 76: //PINDA probe temperature calibration 
															 | 
															
															 | 
															
																 	case 76: //PINDA probe temperature calibration 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 	{ 
															 | 
															
															 | 
															
																 	{ 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 		setTargetBed(PINDA_MIN_T); 
															 | 
															
															 | 
															
																 		setTargetBed(PINDA_MIN_T); 
															 | 
														
													
												
											
												
													
														
															 | 
															
																@@ -2812,7 +2824,7 @@ void process_commands() 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 		custom_message = MSG_TEMP_CALIBRATION; 
															 | 
															
															 | 
															
																 		custom_message = MSG_TEMP_CALIBRATION; 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 		current_position[X_AXIS] = PINDA_PREHEAT_X; 
															 | 
															
															 | 
															
																 		current_position[X_AXIS] = PINDA_PREHEAT_X; 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 		current_position[Y_AXIS] = PINDA_PREHEAT_Y; 
															 | 
															
															 | 
															
																 		current_position[Y_AXIS] = PINDA_PREHEAT_Y; 
															 | 
														
													
												
													
														
															| 
															 | 
															
																-		current_position[Z_AXIS] = 0; 
															 | 
															
															 | 
															
																 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 
															 | 
															
															 | 
															
																+		current_position[Z_AXIS] = PINDA_PREHEAT_Z; 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 		plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], 3000 / 60, active_extruder); 
															 | 
															
															 | 
															
																 		plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], 3000 / 60, active_extruder); 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 		st_synchronize(); 
															 | 
															
															 | 
															
																 		st_synchronize(); 
															 | 
														
													
												
													
														
															| 
															 | 
															
																  
															 | 
															
															 | 
															
																  
															 | 
														
													
												
											
												
													
														
															 | 
															
																@@ -2845,7 +2857,7 @@ void process_commands() 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 			setTargetBed(t_c); 
															 | 
															
															 | 
															
																 			setTargetBed(t_c); 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 			current_position[X_AXIS] = PINDA_PREHEAT_X; 
															 | 
															
															 | 
															
																 			current_position[X_AXIS] = PINDA_PREHEAT_X; 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 			current_position[Y_AXIS] = PINDA_PREHEAT_Y; 
															 | 
															
															 | 
															
																 			current_position[Y_AXIS] = PINDA_PREHEAT_Y; 
															 | 
														
													
												
													
														
															| 
															 | 
															
																-			current_position[Z_AXIS] = 0; 
															 | 
															
															 | 
															
																 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 
															 | 
															
															 | 
															
																+			current_position[Z_AXIS] = PINDA_PREHEAT_Z; 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 			plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], 3000 / 60, active_extruder); 
															 | 
															
															 | 
															
																 			plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], 3000 / 60, active_extruder); 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 			st_synchronize(); 
															 | 
															
															 | 
															
																 			st_synchronize(); 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 			while (degBed() < t_c) delay_keep_alive(1000); 
															 | 
															
															 | 
															
																 			while (degBed() < t_c) delay_keep_alive(1000); 
															 | 
														
													
												
											
												
													
														
															 | 
															
																@@ -2926,7 +2938,7 @@ void process_commands() 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 	* 
															 | 
															
															 | 
															
																 	* 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 	*/ 
															 | 
															
															 | 
															
																 	*/ 
															 | 
														
													
												
													
														
															| 
															 | 
															
																  
															 | 
															
															 | 
															
																  
															 | 
														
													
												
													
														
															| 
															 | 
															
																-  case 80: 
															 | 
															
															 | 
															
																 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 
															 | 
															
															 | 
															
																+	case 80: 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 	case_G80: 
															 | 
															
															 | 
															
																 	case_G80: 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 	{ 
															 | 
															
															 | 
															
																 	{ 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 		mesh_bed_leveling_flag = true; 
															 | 
															
															 | 
															
																 		mesh_bed_leveling_flag = true; 
															 | 
														
													
												
											
												
													
														
															 | 
															
																@@ -6315,11 +6327,11 @@ void temp_compensation_start() { 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 	 
															 | 
															
															 | 
															
																 	 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 	current_position[X_AXIS] = PINDA_PREHEAT_X; 
															 | 
															
															 | 
															
																 	current_position[X_AXIS] = PINDA_PREHEAT_X; 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 	current_position[Y_AXIS] = PINDA_PREHEAT_Y; 
															 | 
															
															 | 
															
																 	current_position[Y_AXIS] = PINDA_PREHEAT_Y; 
															 | 
														
													
												
													
														
															| 
															 | 
															
																-	current_position[Z_AXIS] = 0; 
															 | 
															
															 | 
															
																 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 
															 | 
															
															 | 
															
																+	current_position[Z_AXIS] = PINDA_PREHEAT_Z; 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 	plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], 3000 / 60, active_extruder); 
															 | 
															
															 | 
															
																 	plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS], current_position[E_AXIS], 3000 / 60, active_extruder); 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 	st_synchronize(); 
															 | 
															
															 | 
															
																 	st_synchronize(); 
															 | 
														
													
												
													
														
															| 
															 | 
															
																  
															 | 
															
															 | 
															
																  
															 | 
														
													
												
													
														
															| 
															 | 
															
																-	while (fabs(degBed() - target_temperature_bed) > 3) delay_keep_alive(1000); 
															 | 
															
															 | 
															
																 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 
															 | 
															
															 | 
															
																+	while (fabs(degBed() - target_temperature_bed) > 1) delay_keep_alive(1000); 
															 | 
														
													
												
													
														
															| 
															 | 
															
																  
															 | 
															
															 | 
															
																  
															 | 
														
													
												
													
														
															| 
															 | 
															
																 	for(int i = 0; i < PINDA_HEAT_T; i++) delay_keep_alive(1000); 
															 | 
															
															 | 
															
																 	for(int i = 0; i < PINDA_HEAT_T; i++) delay_keep_alive(1000); 
															 | 
														
													
												
													
														
															| 
															 | 
															
																  
															 | 
															
															 | 
															
																  
															 | 
														
													
												
											
												
													
														
															 | 
															
																@@ -6334,12 +6346,11 @@ void temp_compensation_apply() { 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 	float z_shift_mm; 
															 | 
															
															 | 
															
																 	float z_shift_mm; 
															 | 
														
													
												
													
														
															| 
															 | 
															
																  
															 | 
															
															 | 
															
																  
															 | 
														
													
												
													
														
															| 
															 | 
															
																 	if (calibration_status() == CALIBRATION_STATUS_CALIBRATED) { 
															 | 
															
															 | 
															
																 	if (calibration_status() == CALIBRATION_STATUS_CALIBRATED) { 
															 | 
														
													
												
													
														
															| 
															 | 
															
																-		if (target_temperature_bed % 10 == 0 && target_temperature_bed >= 50 && target_temperature_bed <= 100) { 
															 | 
															
															 | 
															
																 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 
															 | 
															
															 | 
															
																+		if (target_temperature_bed % 10 == 0 && target_temperature_bed >= 60 && target_temperature_bed <= 100) { 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 			i_add = (target_temperature_bed - 60) / 10; 
															 | 
															
															 | 
															
																 			i_add = (target_temperature_bed - 60) / 10; 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 			EEPROM_read_B(EEPROM_PROBE_TEMP_SHIFT + i_add * 2, &z_shift); 
															 | 
															
															 | 
															
																 			EEPROM_read_B(EEPROM_PROBE_TEMP_SHIFT + i_add * 2, &z_shift); 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 			z_shift_mm = z_shift / axis_steps_per_unit[Z_AXIS]; 
															 | 
															
															 | 
															
																 			z_shift_mm = z_shift / axis_steps_per_unit[Z_AXIS]; 
															 | 
														
													
												
													
														
															| 
															 | 
															
																-		} 
															 | 
															
															 | 
															
																 
															 | 
														
													
												
													
														
															| 
															 | 
															
																-		else { 
															 | 
															
															 | 
															
																 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 
															 | 
															
															 | 
															
																+		}else { 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 			//interpolation 
															 | 
															
															 | 
															
																 			//interpolation 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 			z_shift_mm = temp_comp_interpolation(target_temperature_bed) / axis_steps_per_unit[Z_AXIS]; 
															 | 
															
															 | 
															
																 			z_shift_mm = temp_comp_interpolation(target_temperature_bed) / axis_steps_per_unit[Z_AXIS]; 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 		} 
															 | 
															
															 | 
															
																 		} 
															 | 
														
													
												
											
												
													
														
															 | 
															
																@@ -6351,7 +6362,7 @@ void temp_compensation_apply() { 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 		plan_set_z_position(current_position[Z_AXIS]); 
															 | 
															
															 | 
															
																 		plan_set_z_position(current_position[Z_AXIS]); 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 	} 
															 | 
															
															 | 
															
																 	} 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 	else {		 
															 | 
															
															 | 
															
																 	else {		 
															 | 
														
													
												
													
														
															| 
															 | 
															
																-		//message that we have no temp compensation data ? 
															 | 
															
															 | 
															
																 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 
															 | 
															
															 | 
															
																+		//we have no temp compensation data 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 	} 
															 | 
															
															 | 
															
																 	} 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 } 
															 | 
															
															 | 
															
																 } 
															 | 
														
													
												
													
														
															| 
															 | 
															
																  
															 | 
															
															 | 
															
																  
															 | 
														
													
												
											
												
													
														
															 | 
															
																@@ -6360,23 +6371,21 @@ float temp_comp_interpolation(float inp_temperature) { 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 	//cubic spline interpolation 
															 | 
															
															 | 
															
																 	//cubic spline interpolation 
															 | 
														
													
												
													
														
															| 
															 | 
															
																  
															 | 
															
															 | 
															
																  
															 | 
														
													
												
													
														
															| 
															 | 
															
																 	int n, i, j, k; 
															 | 
															
															 | 
															
																 	int n, i, j, k; 
															 | 
														
													
												
													
														
															| 
															 | 
															
																-	float h[10], a, b, c, d, sum, s[10] = { 0 }, x[10], F[10], f[10], p, m[10][10] = { 0 }, temp; 
															 | 
															
															 | 
															
																 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 
															 | 
															
															 | 
															
																+	float h[10], a, b, c, d, sum, s[10] = { 0 }, x[10], F[10], f[10], m[10][10] = { 0 }, temp; 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 	int shift[10]; 
															 | 
															
															 | 
															
																 	int shift[10]; 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 	int temp_C[10]; 
															 | 
															
															 | 
															
																 	int temp_C[10]; 
															 | 
														
													
												
													
														
															| 
															 | 
															
																  
															 | 
															
															 | 
															
																  
															 | 
														
													
												
													
														
															| 
															 | 
															
																-	p = inp_temperature; 
															 | 
															
															 | 
															
																 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 	n = 6; //number of measured points 
															 | 
															
															 | 
															
																 	n = 6; //number of measured points 
															 | 
														
													
												
													
														
															| 
															 | 
															
																  
															 | 
															
															 | 
															
																  
															 | 
														
													
												
													
														
															| 
															 | 
															
																 	shift[0] = 0; 
															 | 
															
															 | 
															
																 	shift[0] = 0; 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 	for (i = 0; i < n; i++) { 
															 | 
															
															 | 
															
																 	for (i = 0; i < n; i++) { 
															 | 
														
													
												
													
														
															| 
															 | 
															
																-		//scanf_s("%f%f", &x[i], &f[i]); 
															 | 
															
															 | 
															
																 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 		if (i>0) EEPROM_read_B(EEPROM_PROBE_TEMP_SHIFT + (i-1) * 2, &shift[i]); //read shift in steps from EEPROM 
															 | 
															
															 | 
															
																 		if (i>0) EEPROM_read_B(EEPROM_PROBE_TEMP_SHIFT + (i-1) * 2, &shift[i]); //read shift in steps from EEPROM 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 		temp_C[i] = 50 + i * 10; //temperature in C 
															 | 
															
															 | 
															
																 		temp_C[i] = 50 + i * 10; //temperature in C 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 		 
															 | 
															
															 | 
															
																 		 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 		x[i] = (float)temp_C[i]; 
															 | 
															
															 | 
															
																 		x[i] = (float)temp_C[i]; 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 		f[i] = (float)shift[i]; 
															 | 
															
															 | 
															
																 		f[i] = (float)shift[i]; 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 	} 
															 | 
															
															 | 
															
																 	} 
															 | 
														
													
												
													
														
															| 
															 | 
															
																- 
															 | 
															
															 | 
															
																 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 
															 | 
															
															 | 
															
																+	if (inp_temperature < x[0]) return 0; 
															 | 
														
													
												
													
														
															| 
															 | 
															
																  
															 | 
															
															 | 
															
																  
															 | 
														
													
												
													
														
															| 
															 | 
															
																  
															 | 
															
															 | 
															
																  
															 | 
														
													
												
													
														
															| 
															 | 
															
																 	for (i = n - 1; i>0; i--) { 
															 | 
															
															 | 
															
																 	for (i = n - 1; i>0; i--) { 
															 | 
														
													
												
											
												
													
														
															 | 
															
																@@ -6407,12 +6416,12 @@ float temp_comp_interpolation(float inp_temperature) { 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 	} 
															 | 
															
															 | 
															
																 	} 
															 | 
														
													
												
													
														
															| 
															 | 
															
																  
															 | 
															
															 | 
															
																  
															 | 
														
													
												
													
														
															| 
															 | 
															
																 		for (i = 0; i<n - 1; i++) 
															 | 
															
															 | 
															
																 		for (i = 0; i<n - 1; i++) 
															 | 
														
													
												
													
														
															| 
															 | 
															
																-			if (x[i] <= p&&p <= x[i + 1]) { 
															 | 
															
															 | 
															
																 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 
															 | 
															
															 | 
															
																+			if ((x[i] <= inp_temperature && inp_temperature <= x[i + 1]) || (i == n-2 && inp_temperature > x[i + 1])) { 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 				a = (s[i + 1] - s[i]) / (6 * h[i]); 
															 | 
															
															 | 
															
																 				a = (s[i + 1] - s[i]) / (6 * h[i]); 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 				b = s[i] / 2; 
															 | 
															
															 | 
															
																 				b = s[i] / 2; 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 				c = (f[i + 1] - f[i]) / h[i] - (2 * h[i] * s[i] + s[i + 1] * h[i]) / 6; 
															 | 
															
															 | 
															
																 				c = (f[i + 1] - f[i]) / h[i] - (2 * h[i] * s[i] + s[i + 1] * h[i]) / 6; 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 				d = f[i]; 
															 | 
															
															 | 
															
																 				d = f[i]; 
															 | 
														
													
												
													
														
															| 
															 | 
															
																-				sum = a*pow((p - x[i]), 3) + b*pow((p - x[i]), 2) + c*(p - x[i]) + d; 
															 | 
															
															 | 
															
																 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 
															 | 
															
															 | 
															
																+				sum = a*pow((inp_temperature - x[i]), 3) + b*pow((inp_temperature - x[i]), 2) + c*(inp_temperature - x[i]) + d; 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 			} 
															 | 
															
															 | 
															
																 			} 
															 | 
														
													
												
													
														
															| 
															 | 
															
																  
															 | 
															
															 | 
															
																  
															 | 
														
													
												
													
														
															| 
															 | 
															
																 		return sum; 
															 | 
															
															 | 
															
																 		return sum; 
															 | 
														
													
												
											
												
													
														
															 | 
															
																@@ -6427,8 +6436,8 @@ void long_pause() //long pause print 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 	saved_feedmultiply = feedmultiply;  
															 | 
															
															 | 
															
																 	saved_feedmultiply = feedmultiply;  
															 | 
														
													
												
													
														
															| 
															 | 
															
																 	HotendTempBckp = degTargetHotend(active_extruder); 
															 | 
															
															 | 
															
																 	HotendTempBckp = degTargetHotend(active_extruder); 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 	fanSpeedBckp = fanSpeed; 
															 | 
															
															 | 
															
																 	fanSpeedBckp = fanSpeed; 
															 | 
														
													
												
													
														
															| 
															 | 
															
																-	pause_time += (millis() - starttime); 
															 | 
															
															 | 
															
																 
															 | 
														
													
												
													
														
															| 
															 | 
															
																-	 
															 | 
															
															 | 
															
																 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 
															 | 
															
															 | 
															
																+	start_pause_print = millis(); 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 
															 | 
															
															 | 
															
																+		 
															 | 
														
													
												
													
														
															| 
															 | 
															
																  
															 | 
															
															 | 
															
																  
															 | 
														
													
												
													
														
															| 
															 | 
															
																 	//save position 
															 | 
															
															 | 
															
																 	//save position 
															 | 
														
													
												
													
														
															| 
															 | 
															
																 	pause_lastpos[X_AXIS] = current_position[X_AXIS]; 
															 | 
															
															 | 
															
																 	pause_lastpos[X_AXIS] = current_position[X_AXIS]; 
															 |