|
@@ -1877,6 +1877,15 @@ bool Planner::_populate_block(block_t * const block, bool split_move,
|
1877
|
1877
|
" A:", target.a, " (", da, " steps)"
|
1878
|
1878
|
" B:", target.b, " (", db, " steps)"
|
1879
|
1879
|
" C:", target.c, " (", dc, " steps)"
|
|
1880
|
+ #if LINEAR_AXES >= 4
|
|
1881
|
+ " " AXIS4_STR ":", target.i, " (", di, " steps)"
|
|
1882
|
+ #endif
|
|
1883
|
+ #if LINEAR_AXES >= 5
|
|
1884
|
+ " " AXIS5_STR ":", target.j, " (", dj, " steps)"
|
|
1885
|
+ #endif
|
|
1886
|
+ #if LINEAR_AXES >= 6
|
|
1887
|
+ " " AXIS6_STR ":", target.k, " (", dk, " steps)"
|
|
1888
|
+ #endif
|
1880
|
1889
|
#if HAS_EXTRUDERS
|
1881
|
1890
|
" E:", target.e, " (", de, " steps)"
|
1882
|
1891
|
#endif
|
|
@@ -1953,6 +1962,19 @@ bool Planner::_populate_block(block_t * const block, bool split_move,
|
1953
|
1962
|
if (dk < 0) SBI(dm, K_AXIS)
|
1954
|
1963
|
);
|
1955
|
1964
|
#endif
|
|
1965
|
+
|
|
1966
|
+ #if IS_CORE
|
|
1967
|
+ #if LINEAR_AXES >= 4
|
|
1968
|
+ if (di < 0) SBI(dm, I_AXIS);
|
|
1969
|
+ #endif
|
|
1970
|
+ #if LINEAR_AXES >= 5
|
|
1971
|
+ if (dj < 0) SBI(dm, J_AXIS);
|
|
1972
|
+ #endif
|
|
1973
|
+ #if LINEAR_AXES >= 6
|
|
1974
|
+ if (dk < 0) SBI(dm, K_AXIS);
|
|
1975
|
+ #endif
|
|
1976
|
+ #endif
|
|
1977
|
+
|
1956
|
1978
|
#if HAS_EXTRUDERS
|
1957
|
1979
|
if (de < 0) SBI(dm, E_AXIS);
|
1958
|
1980
|
#endif
|
|
@@ -2004,7 +2026,7 @@ bool Planner::_populate_block(block_t * const block, bool split_move,
|
2004
|
2026
|
*/
|
2005
|
2027
|
struct DistanceMM : abce_float_t {
|
2006
|
2028
|
#if EITHER(IS_CORE, MARKFORGED_XY)
|
2007
|
|
- xyz_pos_t head;
|
|
2029
|
+ struct { float x, y, z; } head;
|
2008
|
2030
|
#endif
|
2009
|
2031
|
} steps_dist_mm;
|
2010
|
2032
|
#if IS_CORE
|
|
@@ -2027,6 +2049,15 @@ bool Planner::_populate_block(block_t * const block, bool split_move,
|
2027
|
2049
|
steps_dist_mm.b = (db + dc) * steps_to_mm[B_AXIS];
|
2028
|
2050
|
steps_dist_mm.c = CORESIGN(db - dc) * steps_to_mm[C_AXIS];
|
2029
|
2051
|
#endif
|
|
2052
|
+ #if LINEAR_AXES >= 4
|
|
2053
|
+ steps_dist_mm.i = di * steps_to_mm[I_AXIS];
|
|
2054
|
+ #endif
|
|
2055
|
+ #if LINEAR_AXES >= 5
|
|
2056
|
+ steps_dist_mm.j = dj * steps_to_mm[J_AXIS];
|
|
2057
|
+ #endif
|
|
2058
|
+ #if LINEAR_AXES >= 6
|
|
2059
|
+ steps_dist_mm.k = dk * steps_to_mm[K_AXIS];
|
|
2060
|
+ #endif
|
2030
|
2061
|
#elif ENABLED(MARKFORGED_XY)
|
2031
|
2062
|
steps_dist_mm.head.x = da * steps_to_mm[A_AXIS];
|
2032
|
2063
|
steps_dist_mm.head.y = db * steps_to_mm[B_AXIS];
|