|
|
@ -405,33 +405,25 @@ class Planner {
|
|
|
|
#endif // SKEW_CORRECTION
|
|
|
|
#endif // SKEW_CORRECTION
|
|
|
|
|
|
|
|
|
|
|
|
#if PLANNER_LEVELING || HAS_UBL_AND_CURVES
|
|
|
|
#if PLANNER_LEVELING || HAS_UBL_AND_CURVES
|
|
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
/**
|
|
|
|
* Apply leveling to transform a cartesian position
|
|
|
|
* Apply leveling to transform a cartesian position
|
|
|
|
* as it will be given to the planner and steppers.
|
|
|
|
* as it will be given to the planner and steppers.
|
|
|
|
*/
|
|
|
|
*/
|
|
|
|
static void apply_leveling(float &rx, float &ry, float &rz);
|
|
|
|
static void apply_leveling(float &rx, float &ry, float &rz);
|
|
|
|
FORCE_INLINE static void apply_leveling(float (&raw)[XYZ]) { apply_leveling(raw[X_AXIS], raw[Y_AXIS], raw[Z_AXIS]); }
|
|
|
|
FORCE_INLINE static void apply_leveling(float (&raw)[XYZ]) { apply_leveling(raw[X_AXIS], raw[Y_AXIS], raw[Z_AXIS]); }
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
#if PLANNER_LEVELING
|
|
|
|
#if PLANNER_LEVELING
|
|
|
|
|
|
|
|
#define ARG_X float rx
|
|
|
|
#define ARG_X float rx
|
|
|
|
#define ARG_Y float ry
|
|
|
|
#define ARG_Y float ry
|
|
|
|
#define ARG_Z float rz
|
|
|
|
#define ARG_Z float rz
|
|
|
|
static void unapply_leveling(float raw[XYZ]);
|
|
|
|
|
|
|
|
|
|
|
|
static void unapply_leveling(float raw[XYZ]);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#else
|
|
|
|
#else
|
|
|
|
|
|
|
|
|
|
|
|
#define ARG_X const float &rx
|
|
|
|
#define ARG_X const float &rx
|
|
|
|
#define ARG_Y const float &ry
|
|
|
|
#define ARG_Y const float &ry
|
|
|
|
#define ARG_Z const float &rz
|
|
|
|
#define ARG_Z const float &rz
|
|
|
|
|
|
|
|
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
/**
|
|
|
|
* Planner::get_next_free_block
|
|
|
|
* Planner::get_next_free_block
|
|
|
|
*
|
|
|
|
*
|
|
|
|