Correct unskew, after all
This commit is contained in:
parent
c5632bb91b
commit
09d13f186f
|
@ -363,7 +363,7 @@ class Planner {
|
||||||
|
|
||||||
FORCE_INLINE static void unskew(float &cx, float &cy, const float &cz) {
|
FORCE_INLINE static void unskew(float &cx, float &cy, const float &cz) {
|
||||||
if (WITHIN(cx, X_MIN_POS, X_MAX_POS) && WITHIN(cy, Y_MIN_POS, Y_MAX_POS)) {
|
if (WITHIN(cx, X_MIN_POS, X_MAX_POS) && WITHIN(cy, Y_MIN_POS, Y_MAX_POS)) {
|
||||||
const float sx = cx + cy * xy_skew_factor + cz * (xz_skew_factor - (xy_skew_factor * yz_skew_factor)),
|
const float sx = cx + cy * xy_skew_factor + cz * xz_skew_factor,
|
||||||
sy = cy + cz * yz_skew_factor;
|
sy = cy + cz * yz_skew_factor;
|
||||||
if (WITHIN(sx, X_MIN_POS, X_MAX_POS) && WITHIN(sy, Y_MIN_POS, Y_MAX_POS)) {
|
if (WITHIN(sx, X_MIN_POS, X_MAX_POS) && WITHIN(sy, Y_MIN_POS, Y_MAX_POS)) {
|
||||||
cx = sx; cy = sy;
|
cx = sx; cy = sy;
|
||||||
|
|
Loading…
Reference in a new issue