|
|
@ -1025,18 +1025,18 @@ void Planner::check_axes_activity() {
|
|
|
|
* On CORE machines XYZ is derived from ABC.
|
|
|
|
* On CORE machines XYZ is derived from ABC.
|
|
|
|
*/
|
|
|
|
*/
|
|
|
|
vector_3 Planner::adjusted_position() {
|
|
|
|
vector_3 Planner::adjusted_position() {
|
|
|
|
vector_3 position = vector_3(stepper.get_axis_position_mm(X_AXIS), stepper.get_axis_position_mm(Y_AXIS), stepper.get_axis_position_mm(Z_AXIS));
|
|
|
|
vector_3 pos = vector_3(stepper.get_axis_position_mm(X_AXIS), stepper.get_axis_position_mm(Y_AXIS), stepper.get_axis_position_mm(Z_AXIS));
|
|
|
|
|
|
|
|
|
|
|
|
//position.debug("in Planner::position");
|
|
|
|
//pos.debug("in Planner::adjusted_position");
|
|
|
|
//bed_level_matrix.debug("in Planner::position");
|
|
|
|
//bed_level_matrix.debug("in Planner::adjusted_position");
|
|
|
|
|
|
|
|
|
|
|
|
matrix_3x3 inverse = matrix_3x3::transpose(bed_level_matrix);
|
|
|
|
matrix_3x3 inverse = matrix_3x3::transpose(bed_level_matrix);
|
|
|
|
//inverse.debug("in Planner::inverse");
|
|
|
|
//inverse.debug("in Planner::inverse");
|
|
|
|
|
|
|
|
|
|
|
|
position.apply_rotation(inverse);
|
|
|
|
pos.apply_rotation(inverse);
|
|
|
|
//position.debug("after rotation");
|
|
|
|
//pos.debug("after rotation");
|
|
|
|
|
|
|
|
|
|
|
|
return position;
|
|
|
|
return pos;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
#endif // AUTO_BED_LEVELING_FEATURE && !DELTA
|
|
|
|
#endif // AUTO_BED_LEVELING_FEATURE && !DELTA
|
|
|
|