|
@ -6183,10 +6183,31 @@ inline void gcode_T(uint8_t tmp_extruder) { |
|
|
extruder_offset[Y_AXIS][active_extruder], |
|
|
extruder_offset[Y_AXIS][active_extruder], |
|
|
extruder_offset[Z_AXIS][active_extruder]), |
|
|
extruder_offset[Z_AXIS][active_extruder]), |
|
|
offset_vec = tmp_offset_vec - act_offset_vec; |
|
|
offset_vec = tmp_offset_vec - act_offset_vec; |
|
|
|
|
|
|
|
|
|
|
|
#if ENABLED(DEBUG_LEVELING_FEATURE) |
|
|
|
|
|
if (DEBUGGING(LEVELING)) { |
|
|
|
|
|
SERIAL_ECHOLNPGM(">>> gcode_T"); |
|
|
|
|
|
tmp_offset_vec.debug("tmp_offset_vec"); |
|
|
|
|
|
act_offset_vec.debug("act_offset_vec"); |
|
|
|
|
|
offset_vec.debug("offset_vec (BEFORE)"); |
|
|
|
|
|
DEBUG_POS("BEFORE rotation", current_position); |
|
|
|
|
|
} |
|
|
|
|
|
#endif |
|
|
|
|
|
|
|
|
offset_vec.apply_rotation(plan_bed_level_matrix.transpose(plan_bed_level_matrix)); |
|
|
offset_vec.apply_rotation(plan_bed_level_matrix.transpose(plan_bed_level_matrix)); |
|
|
|
|
|
|
|
|
current_position[X_AXIS] += offset_vec.x; |
|
|
current_position[X_AXIS] += offset_vec.x; |
|
|
current_position[Y_AXIS] += offset_vec.y; |
|
|
current_position[Y_AXIS] += offset_vec.y; |
|
|
current_position[Z_AXIS] += offset_vec.z; |
|
|
current_position[Z_AXIS] += offset_vec.z; |
|
|
|
|
|
|
|
|
|
|
|
#if ENABLED(DEBUG_LEVELING_FEATURE) |
|
|
|
|
|
if (DEBUGGING(LEVELING)) { |
|
|
|
|
|
offset_vec.debug("offset_vec (AFTER)"); |
|
|
|
|
|
DEBUG_POS("AFTER rotation", current_position); |
|
|
|
|
|
SERIAL_ECHOLNPGM("<<< gcode_T"); |
|
|
|
|
|
} |
|
|
|
|
|
#endif |
|
|
|
|
|
|
|
|
#else // !AUTO_BED_LEVELING_FEATURE
|
|
|
#else // !AUTO_BED_LEVELING_FEATURE
|
|
|
// Offset extruder (only by XY)
|
|
|
// Offset extruder (only by XY)
|
|
|
for (int i=X_AXIS; i<=Y_AXIS; i++) |
|
|
for (int i=X_AXIS; i<=Y_AXIS; i++) |
|
|