diff --git a/Firmware/xyzcal.cpp b/Firmware/xyzcal.cpp index b25be9711..af68ea229 100644 --- a/Firmware/xyzcal.cpp +++ b/Firmware/xyzcal.cpp @@ -455,7 +455,6 @@ void xyzcal_scan_pixels_32x32_Zhop(int16_t cx, int16_t cy, int16_t min_z, int16_ uint16_t current_delay_us = MAX_DELAY; ///< defines current speed xyzcal_lineXYZ_to(cx - 1024, cy - 1024, min_z, delay_us, 0); int16_t start_z; - // int16_t last_top_z; uint16_t steps_to_go; for (uint8_t r = 0; r < 32; r++){ ///< Y axis @@ -468,7 +467,6 @@ void xyzcal_scan_pixels_32x32_Zhop(int16_t cx, int16_t cy, int16_t min_z, int16_ for (uint8_t c = 0; c < 32; c++){ ///< X axis z_trig = min_z; - last_top_z = max_z; /// move up to un-trigger (surpress hysteresis) sm4_set_dir(Z_AXIS, Z_PLUS); @@ -476,7 +474,6 @@ void xyzcal_scan_pixels_32x32_Zhop(int16_t cx, int16_t cy, int16_t min_z, int16_ current_delay_us = MAX_DELAY; for (start_z = z; z < (max_z + start_z) / 2; ++z){ if (!_PINDA){ - // last_top_z = z; break; } accelerate(Z_AXIS_MASK, Z_ACCEL, current_delay_us, Z_MIN_DELAY); @@ -488,7 +485,6 @@ void xyzcal_scan_pixels_32x32_Zhop(int16_t cx, int16_t cy, int16_t min_z, int16_ go_and_stop(Z_AXIS_MASK, Z_ACCEL, current_delay_us, steps_to_go); ++z; } - // last_top_z = z; } /// slow down to stop while (current_delay_us < MAX_DELAY){ @@ -552,12 +548,8 @@ void xyzcal_scan_pixels_32x32_Zhop(int16_t cx, int16_t cy, int16_t min_z, int16_ for (; x < length_x; ++x, ++z){ go_and_stop(axis, Z_ACCEL, current_delay_us, steps_to_go); } - count_position[0] = end_x; count_position[2] = z; - - // xyzcal_lineXYZ_to(((d & 1) ? 1 : -1) * (64 * (16 - c) - 32) + cx, _Y, (last_top_z + z) / 2, delay_us, 0); - // z = _Z; } } // DBG(_n("\n\n"));