|
|
@ -1015,8 +1015,8 @@ void Planner::reverse_pass() {
|
|
|
|
// Perform the reverse pass
|
|
|
|
// Perform the reverse pass
|
|
|
|
block_t *current = &block_buffer[block_index];
|
|
|
|
block_t *current = &block_buffer[block_index];
|
|
|
|
|
|
|
|
|
|
|
|
// Only consider non sync and page blocks
|
|
|
|
// Only consider non sync-and-page blocks
|
|
|
|
if (!TEST(current->flag, BLOCK_BIT_SYNC_POSITION) && !IS_PAGE(current)) {
|
|
|
|
if (!(current->flag & BLOCK_MASK_SYNC) && !IS_PAGE(current)) {
|
|
|
|
reverse_pass_kernel(current, next);
|
|
|
|
reverse_pass_kernel(current, next);
|
|
|
|
next = current;
|
|
|
|
next = current;
|
|
|
|
}
|
|
|
|
}
|
|
|
@ -1111,7 +1111,7 @@ void Planner::forward_pass() {
|
|
|
|
block = &block_buffer[block_index];
|
|
|
|
block = &block_buffer[block_index];
|
|
|
|
|
|
|
|
|
|
|
|
// Skip SYNC and page blocks
|
|
|
|
// Skip SYNC and page blocks
|
|
|
|
if (!TEST(block->flag, BLOCK_BIT_SYNC_POSITION) && !IS_PAGE(block)) {
|
|
|
|
if (!(block->flag & BLOCK_MASK_SYNC) && !IS_PAGE(block)) {
|
|
|
|
// If there's no previous block or the previous block is not
|
|
|
|
// If there's no previous block or the previous block is not
|
|
|
|
// BUSY (thus, modifiable) run the forward_pass_kernel. Otherwise,
|
|
|
|
// BUSY (thus, modifiable) run the forward_pass_kernel. Otherwise,
|
|
|
|
// the previous block became BUSY, so assume the current block's
|
|
|
|
// the previous block became BUSY, so assume the current block's
|
|
|
@ -1147,7 +1147,7 @@ void Planner::recalculate_trapezoids() {
|
|
|
|
block_t *prev = &block_buffer[prev_index];
|
|
|
|
block_t *prev = &block_buffer[prev_index];
|
|
|
|
|
|
|
|
|
|
|
|
// If not dealing with a sync block, we are done. The last block is not a SYNC block
|
|
|
|
// If not dealing with a sync block, we are done. The last block is not a SYNC block
|
|
|
|
if (!TEST(prev->flag, BLOCK_BIT_SYNC_POSITION)) break;
|
|
|
|
if (!(prev->flag & BLOCK_MASK_SYNC)) break;
|
|
|
|
|
|
|
|
|
|
|
|
// Examine the previous block. This and all following are SYNC blocks
|
|
|
|
// Examine the previous block. This and all following are SYNC blocks
|
|
|
|
head_block_index = prev_index;
|
|
|
|
head_block_index = prev_index;
|
|
|
@ -1161,7 +1161,7 @@ void Planner::recalculate_trapezoids() {
|
|
|
|
next = &block_buffer[block_index];
|
|
|
|
next = &block_buffer[block_index];
|
|
|
|
|
|
|
|
|
|
|
|
// Skip sync and page blocks
|
|
|
|
// Skip sync and page blocks
|
|
|
|
if (!TEST(next->flag, BLOCK_BIT_SYNC_POSITION) && !IS_PAGE(next)) {
|
|
|
|
if (!(next->flag & BLOCK_MASK_SYNC) && !IS_PAGE(next)) {
|
|
|
|
next_entry_speed = SQRT(next->entry_speed_sqr);
|
|
|
|
next_entry_speed = SQRT(next->entry_speed_sqr);
|
|
|
|
|
|
|
|
|
|
|
|
if (block) {
|
|
|
|
if (block) {
|
|
|
@ -1248,6 +1248,63 @@ void Planner::recalculate() {
|
|
|
|
recalculate_trapezoids();
|
|
|
|
recalculate_trapezoids();
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#if HAS_FAN && DISABLED(LASER_SYNCHRONOUS_M106_M107)
|
|
|
|
|
|
|
|
#define HAS_TAIL_FAN_SPEED 1
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
|
|
|
* Apply fan speeds
|
|
|
|
|
|
|
|
*/
|
|
|
|
|
|
|
|
#if HAS_FAN
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void Planner::sync_fan_speeds(uint8_t (&fan_speed)[FAN_COUNT]) {
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#if FAN_MIN_PWM != 0 || FAN_MAX_PWM != 255
|
|
|
|
|
|
|
|
#define CALC_FAN_SPEED(f) (fan_speed[f] ? map(fan_speed[f], 1, 255, FAN_MIN_PWM, FAN_MAX_PWM) : FAN_OFF_PWM)
|
|
|
|
|
|
|
|
#else
|
|
|
|
|
|
|
|
#define CALC_FAN_SPEED(f) (fan_speed[f] ?: FAN_OFF_PWM)
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#if ENABLED(FAN_SOFT_PWM)
|
|
|
|
|
|
|
|
#define _FAN_SET(F) thermalManager.soft_pwm_amount_fan[F] = CALC_FAN_SPEED(F);
|
|
|
|
|
|
|
|
#elif ENABLED(FAST_PWM_FAN)
|
|
|
|
|
|
|
|
#define _FAN_SET(F) set_pwm_duty(FAN##F##_PIN, CALC_FAN_SPEED(F));
|
|
|
|
|
|
|
|
#else
|
|
|
|
|
|
|
|
#define _FAN_SET(F) analogWrite(pin_t(FAN##F##_PIN), CALC_FAN_SPEED(F));
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
#define FAN_SET(F) do{ kickstart_fan(fan_speed, ms, F); _FAN_SET(F); }while(0)
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
const millis_t ms = millis();
|
|
|
|
|
|
|
|
TERN_(HAS_FAN0, FAN_SET(0));
|
|
|
|
|
|
|
|
TERN_(HAS_FAN1, FAN_SET(1));
|
|
|
|
|
|
|
|
TERN_(HAS_FAN2, FAN_SET(2));
|
|
|
|
|
|
|
|
TERN_(HAS_FAN3, FAN_SET(3));
|
|
|
|
|
|
|
|
TERN_(HAS_FAN4, FAN_SET(4));
|
|
|
|
|
|
|
|
TERN_(HAS_FAN5, FAN_SET(5));
|
|
|
|
|
|
|
|
TERN_(HAS_FAN6, FAN_SET(6));
|
|
|
|
|
|
|
|
TERN_(HAS_FAN7, FAN_SET(7));
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#if FAN_KICKSTART_TIME
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void Planner::kickstart_fan(uint8_t (&fan_speed)[FAN_COUNT], const millis_t &ms, const uint8_t f) {
|
|
|
|
|
|
|
|
static millis_t fan_kick_end[FAN_COUNT] = { 0 };
|
|
|
|
|
|
|
|
if (fan_speed[f]) {
|
|
|
|
|
|
|
|
if (fan_kick_end[f] == 0) {
|
|
|
|
|
|
|
|
fan_kick_end[f] = ms + FAN_KICKSTART_TIME;
|
|
|
|
|
|
|
|
fan_speed[f] = 255;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
else if (PENDING(ms, fan_kick_end[f]))
|
|
|
|
|
|
|
|
fan_speed[f] = 255;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
else
|
|
|
|
|
|
|
|
fan_kick_end[f] = 0;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#endif // HAS_FAN
|
|
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
/**
|
|
|
|
* Maintain fans, paste extruder pressure,
|
|
|
|
* Maintain fans, paste extruder pressure,
|
|
|
|
*/
|
|
|
|
*/
|
|
|
@ -1257,7 +1314,7 @@ void Planner::check_axes_activity() {
|
|
|
|
xyze_bool_t axis_active = { false };
|
|
|
|
xyze_bool_t axis_active = { false };
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
#if HAS_FAN
|
|
|
|
#if HAS_TAIL_FAN_SPEED
|
|
|
|
uint8_t tail_fan_speed[FAN_COUNT];
|
|
|
|
uint8_t tail_fan_speed[FAN_COUNT];
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
@ -1272,13 +1329,12 @@ void Planner::check_axes_activity() {
|
|
|
|
|
|
|
|
|
|
|
|
if (has_blocks_queued()) {
|
|
|
|
if (has_blocks_queued()) {
|
|
|
|
|
|
|
|
|
|
|
|
#if HAS_FAN || ENABLED(BARICUDA)
|
|
|
|
#if EITHER(HAS_TAIL_FAN_SPEED, BARICUDA)
|
|
|
|
block_t *block = &block_buffer[block_buffer_tail];
|
|
|
|
block_t *block = &block_buffer[block_buffer_tail];
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
#if HAS_FAN
|
|
|
|
#if HAS_TAIL_FAN_SPEED
|
|
|
|
FANS_LOOP(i)
|
|
|
|
FANS_LOOP(i) tail_fan_speed[i] = thermalManager.scaledFanSpeed(i, block->fan_speed[i]);
|
|
|
|
tail_fan_speed[i] = thermalManager.scaledFanSpeed(i, block->fan_speed[i]);
|
|
|
|
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
#if ENABLED(BARICUDA)
|
|
|
|
#if ENABLED(BARICUDA)
|
|
|
@ -1300,9 +1356,8 @@ void Planner::check_axes_activity() {
|
|
|
|
|
|
|
|
|
|
|
|
TERN_(HAS_CUTTER, cutter.refresh());
|
|
|
|
TERN_(HAS_CUTTER, cutter.refresh());
|
|
|
|
|
|
|
|
|
|
|
|
#if HAS_FAN
|
|
|
|
#if HAS_TAIL_FAN_SPEED
|
|
|
|
FANS_LOOP(i)
|
|
|
|
FANS_LOOP(i) tail_fan_speed[i] = thermalManager.scaledFanSpeed(i);
|
|
|
|
tail_fan_speed[i] = thermalManager.scaledFanSpeed(i);
|
|
|
|
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
#if ENABLED(BARICUDA)
|
|
|
|
#if ENABLED(BARICUDA)
|
|
|
@ -1321,49 +1376,12 @@ void Planner::check_axes_activity() {
|
|
|
|
|
|
|
|
|
|
|
|
//
|
|
|
|
//
|
|
|
|
// Update Fan speeds
|
|
|
|
// Update Fan speeds
|
|
|
|
|
|
|
|
// Only if synchronous M106/M107 is disabled
|
|
|
|
//
|
|
|
|
//
|
|
|
|
#if HAS_FAN
|
|
|
|
#if HAS_TAIL_FAN_SPEED
|
|
|
|
|
|
|
|
sync_fan_speeds(tail_fan_speed);
|
|
|
|
#if FAN_KICKSTART_TIME > 0
|
|
|
|
|
|
|
|
static millis_t fan_kick_end[FAN_COUNT] = { 0 };
|
|
|
|
|
|
|
|
#define KICKSTART_FAN(f) \
|
|
|
|
|
|
|
|
if (tail_fan_speed[f]) { \
|
|
|
|
|
|
|
|
millis_t ms = millis(); \
|
|
|
|
|
|
|
|
if (fan_kick_end[f] == 0) { \
|
|
|
|
|
|
|
|
fan_kick_end[f] = ms + FAN_KICKSTART_TIME; \
|
|
|
|
|
|
|
|
tail_fan_speed[f] = 255; \
|
|
|
|
|
|
|
|
} else if (PENDING(ms, fan_kick_end[f])) \
|
|
|
|
|
|
|
|
tail_fan_speed[f] = 255; \
|
|
|
|
|
|
|
|
} else fan_kick_end[f] = 0
|
|
|
|
|
|
|
|
#else
|
|
|
|
|
|
|
|
#define KICKSTART_FAN(f) NOOP
|
|
|
|
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
#if FAN_MIN_PWM != 0 || FAN_MAX_PWM != 255
|
|
|
|
|
|
|
|
#define CALC_FAN_SPEED(f) (tail_fan_speed[f] ? map(tail_fan_speed[f], 1, 255, FAN_MIN_PWM, FAN_MAX_PWM) : FAN_OFF_PWM)
|
|
|
|
|
|
|
|
#else
|
|
|
|
|
|
|
|
#define CALC_FAN_SPEED(f) (tail_fan_speed[f] ?: FAN_OFF_PWM)
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#if ENABLED(FAN_SOFT_PWM)
|
|
|
|
|
|
|
|
#define _FAN_SET(F) thermalManager.soft_pwm_amount_fan[F] = CALC_FAN_SPEED(F);
|
|
|
|
|
|
|
|
#elif ENABLED(FAST_PWM_FAN)
|
|
|
|
|
|
|
|
#define _FAN_SET(F) set_pwm_duty(FAN##F##_PIN, CALC_FAN_SPEED(F));
|
|
|
|
|
|
|
|
#else
|
|
|
|
|
|
|
|
#define _FAN_SET(F) analogWrite(pin_t(FAN##F##_PIN), CALC_FAN_SPEED(F));
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
#define FAN_SET(F) do{ KICKSTART_FAN(F); _FAN_SET(F); }while(0)
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
TERN_(HAS_FAN0, FAN_SET(0));
|
|
|
|
|
|
|
|
TERN_(HAS_FAN1, FAN_SET(1));
|
|
|
|
|
|
|
|
TERN_(HAS_FAN2, FAN_SET(2));
|
|
|
|
|
|
|
|
TERN_(HAS_FAN3, FAN_SET(3));
|
|
|
|
|
|
|
|
TERN_(HAS_FAN4, FAN_SET(4));
|
|
|
|
|
|
|
|
TERN_(HAS_FAN5, FAN_SET(5));
|
|
|
|
|
|
|
|
TERN_(HAS_FAN6, FAN_SET(6));
|
|
|
|
|
|
|
|
TERN_(HAS_FAN7, FAN_SET(7));
|
|
|
|
|
|
|
|
#endif // HAS_FAN
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
TERN_(AUTOTEMP, getHighESpeed());
|
|
|
|
TERN_(AUTOTEMP, getHighESpeed());
|
|
|
|
|
|
|
|
|
|
|
|
#if ENABLED(BARICUDA)
|
|
|
|
#if ENABLED(BARICUDA)
|
|
|
@ -2675,9 +2693,14 @@ bool Planner::_populate_block(block_t * const block, bool split_move,
|
|
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
/**
|
|
|
|
* Planner::buffer_sync_block
|
|
|
|
* Planner::buffer_sync_block
|
|
|
|
* Add a block to the buffer that just updates the position
|
|
|
|
* Add a block to the buffer that just updates the position,
|
|
|
|
|
|
|
|
* or in case of LASER_SYNCHRONOUS_M106_M107 the fan PWM
|
|
|
|
*/
|
|
|
|
*/
|
|
|
|
void Planner::buffer_sync_block() {
|
|
|
|
void Planner::buffer_sync_block(TERN_(LASER_SYNCHRONOUS_M106_M107, uint8_t sync_flag)) {
|
|
|
|
|
|
|
|
#if DISABLED(LASER_SYNCHRONOUS_M106_M107)
|
|
|
|
|
|
|
|
constexpr uint8_t sync_flag = BLOCK_FLAG_SYNC_POSITION;
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
// Wait for the next available block
|
|
|
|
// Wait for the next available block
|
|
|
|
uint8_t next_buffer_head;
|
|
|
|
uint8_t next_buffer_head;
|
|
|
|
block_t * const block = get_next_free_block(next_buffer_head);
|
|
|
|
block_t * const block = get_next_free_block(next_buffer_head);
|
|
|
@ -2685,10 +2708,14 @@ void Planner::buffer_sync_block() {
|
|
|
|
// Clear block
|
|
|
|
// Clear block
|
|
|
|
memset(block, 0, sizeof(block_t));
|
|
|
|
memset(block, 0, sizeof(block_t));
|
|
|
|
|
|
|
|
|
|
|
|
block->flag = BLOCK_FLAG_SYNC_POSITION;
|
|
|
|
block->flag = sync_flag;
|
|
|
|
|
|
|
|
|
|
|
|
block->position = position;
|
|
|
|
block->position = position;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#if BOTH(HAS_FAN, LASER_SYNCHRONOUS_M106_M107)
|
|
|
|
|
|
|
|
FANS_LOOP(i) block->fan_speed[i] = thermalManager.fan_speed[i];
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
// If this is the first added movement, reload the delay, otherwise, cancel it.
|
|
|
|
// If this is the first added movement, reload the delay, otherwise, cancel it.
|
|
|
|
if (block_buffer_head == block_buffer_tail) {
|
|
|
|
if (block_buffer_head == block_buffer_tail) {
|
|
|
|
// If it was the first queued block, restart the 1st block delivery delay, to
|
|
|
|
// If it was the first queued block, restart the 1st block delivery delay, to
|
|
|
@ -2876,7 +2903,7 @@ bool Planner::buffer_line(const float &rx, const float &ry, const float &rz, con
|
|
|
|
|
|
|
|
|
|
|
|
block->flag = BLOCK_FLAG_IS_PAGE;
|
|
|
|
block->flag = BLOCK_FLAG_IS_PAGE;
|
|
|
|
|
|
|
|
|
|
|
|
#if FAN_COUNT > 0
|
|
|
|
#if HAS_FAN
|
|
|
|
FANS_LOOP(i) block->fan_speed[i] = thermalManager.fan_speed[i];
|
|
|
|
FANS_LOOP(i) block->fan_speed[i] = thermalManager.fan_speed[i];
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|