|
@@ -1628,13 +1628,15 @@ uint32_t Stepper::stepper_block_phase_isr() {
|
1628
|
1628
|
#define Z_MOVE_TEST !!current_block->steps[C_AXIS]
|
1629
|
1629
|
#endif
|
1630
|
1630
|
|
1631
|
|
- SET_BIT_TO(axis_did_move, X_AXIS, X_MOVE_TEST);
|
1632
|
|
- SET_BIT_TO(axis_did_move, Y_AXIS, Y_MOVE_TEST);
|
1633
|
|
- SET_BIT_TO(axis_did_move, Z_AXIS, Z_MOVE_TEST);
|
1634
|
|
- //SET_BIT_TO(axis_did_move, E_AXIS, !!current_block->steps[E_AXIS]);
|
1635
|
|
- //SET_BIT_TO(axis_did_move, X_HEAD, !!current_block->steps[A_AXIS]);
|
1636
|
|
- //SET_BIT_TO(axis_did_move, Y_HEAD, !!current_block->steps[B_AXIS]);
|
1637
|
|
- //SET_BIT_TO(axis_did_move, Z_HEAD, !!current_block->steps[C_AXIS]);
|
|
1631
|
+ uint8_t axis_bits = 0;
|
|
1632
|
+ if (X_MOVE_TEST) SBI(axis_bits, A_AXIS);
|
|
1633
|
+ if (Y_MOVE_TEST) SBI(axis_bits, B_AXIS);
|
|
1634
|
+ if (Z_MOVE_TEST) SBI(axis_bits, C_AXIS);
|
|
1635
|
+ //if (!!current_block->steps[E_AXIS]) SBI(axis_bits, E_AXIS);
|
|
1636
|
+ //if (!!current_block->steps[A_AXIS]) SBI(axis_bits, X_HEAD);
|
|
1637
|
+ //if (!!current_block->steps[B_AXIS]) SBI(axis_bits, Y_HEAD);
|
|
1638
|
+ //if (!!current_block->steps[C_AXIS]) SBI(axis_bits, Z_HEAD);
|
|
1639
|
+ axis_did_move = axis_bits;
|
1638
|
1640
|
|
1639
|
1641
|
// Initialize the trapezoid generator from the current block.
|
1640
|
1642
|
#if ENABLED(LIN_ADVANCE)
|