mirror of
https://github.com/MarlinFirmware/Marlin.git
synced 2024-11-27 13:56:24 +00:00
🎨 Misc. Spindle/Laser (etc.) cleanup
This commit is contained in:
parent
dc6b86065e
commit
845d42ef40
@ -52,9 +52,9 @@ cutter_power_t SpindleLaser::menuPower, // Power s
|
|||||||
#endif
|
#endif
|
||||||
#define SPINDLE_LASER_PWM_OFF TERN(SPINDLE_LASER_PWM_INVERT, 255, 0)
|
#define SPINDLE_LASER_PWM_OFF TERN(SPINDLE_LASER_PWM_INVERT, 255, 0)
|
||||||
|
|
||||||
//
|
/**
|
||||||
// Init the cutter to a safe OFF state
|
* Init the cutter to a safe OFF state
|
||||||
//
|
*/
|
||||||
void SpindleLaser::init() {
|
void SpindleLaser::init() {
|
||||||
#if ENABLED(SPINDLE_SERVO)
|
#if ENABLED(SPINDLE_SERVO)
|
||||||
MOVE_SERVO(SPINDLE_SERVO_NR, SPINDLE_SERVO_MIN);
|
MOVE_SERVO(SPINDLE_SERVO_NR, SPINDLE_SERVO_MIN);
|
||||||
@ -86,6 +86,8 @@ void SpindleLaser::init() {
|
|||||||
#if ENABLED(SPINDLE_LASER_PWM)
|
#if ENABLED(SPINDLE_LASER_PWM)
|
||||||
/**
|
/**
|
||||||
* Set the cutter PWM directly to the given ocr value
|
* Set the cutter PWM directly to the given ocr value
|
||||||
|
*
|
||||||
|
* @param ocr Power value
|
||||||
*/
|
*/
|
||||||
void SpindleLaser::_set_ocr(const uint8_t ocr) {
|
void SpindleLaser::_set_ocr(const uint8_t ocr) {
|
||||||
#if NEEDS_HARDWARE_PWM && SPINDLE_LASER_FREQUENCY
|
#if NEEDS_HARDWARE_PWM && SPINDLE_LASER_FREQUENCY
|
||||||
@ -105,11 +107,15 @@ void SpindleLaser::init() {
|
|||||||
WRITE(SPINDLE_LASER_ENA_PIN, !SPINDLE_LASER_ACTIVE_STATE); // Cutter OFF
|
WRITE(SPINDLE_LASER_ENA_PIN, !SPINDLE_LASER_ACTIVE_STATE); // Cutter OFF
|
||||||
_set_ocr(0);
|
_set_ocr(0);
|
||||||
}
|
}
|
||||||
#endif
|
#endif // SPINDLE_LASER_PWM
|
||||||
|
|
||||||
//
|
/**
|
||||||
// Set cutter ON/OFF state (and PWM) to the given cutter power value
|
* Apply power for laser/spindle
|
||||||
//
|
*
|
||||||
|
* Apply cutter power value for PWM, Servo, and on/off pin.
|
||||||
|
*
|
||||||
|
* @param opwr Power value. Range 0 to MAX. When 0 disable spindle/laser.
|
||||||
|
*/
|
||||||
void SpindleLaser::apply_power(const uint8_t opwr) {
|
void SpindleLaser::apply_power(const uint8_t opwr) {
|
||||||
static uint8_t last_power_applied = 0;
|
static uint8_t last_power_applied = 0;
|
||||||
if (opwr == last_power_applied) return;
|
if (opwr == last_power_applied) return;
|
||||||
@ -137,10 +143,10 @@ void SpindleLaser::apply_power(const uint8_t opwr) {
|
|||||||
}
|
}
|
||||||
|
|
||||||
#if ENABLED(SPINDLE_CHANGE_DIR)
|
#if ENABLED(SPINDLE_CHANGE_DIR)
|
||||||
//
|
/**
|
||||||
// Set the spindle direction and apply immediately
|
* Set the spindle direction and apply immediately
|
||||||
// Stop on direction change if SPINDLE_STOP_ON_DIR_CHANGE is enabled
|
* Stop on direction change if SPINDLE_STOP_ON_DIR_CHANGE is enabled
|
||||||
//
|
*/
|
||||||
void SpindleLaser::set_reverse(const bool reverse) {
|
void SpindleLaser::set_reverse(const bool reverse) {
|
||||||
const bool dir_state = (reverse == SPINDLE_INVERT_DIR); // Forward (M3) HIGH when not inverted
|
const bool dir_state = (reverse == SPINDLE_INVERT_DIR); // Forward (M3) HIGH when not inverted
|
||||||
if (TERN0(SPINDLE_STOP_ON_DIR_CHANGE, enabled()) && READ(SPINDLE_DIR_PIN) != dir_state) disable();
|
if (TERN0(SPINDLE_STOP_ON_DIR_CHANGE, enabled()) && READ(SPINDLE_DIR_PIN) != dir_state) disable();
|
||||||
@ -149,25 +155,17 @@ void SpindleLaser::apply_power(const uint8_t opwr) {
|
|||||||
#endif
|
#endif
|
||||||
|
|
||||||
#if ENABLED(AIR_EVACUATION)
|
#if ENABLED(AIR_EVACUATION)
|
||||||
|
|
||||||
// Enable / disable Cutter Vacuum or Laser Blower motor
|
// Enable / disable Cutter Vacuum or Laser Blower motor
|
||||||
void SpindleLaser::air_evac_enable() { WRITE(AIR_EVACUATION_PIN, AIR_EVACUATION_ACTIVE); } // Turn ON
|
void SpindleLaser::air_evac_enable() { WRITE(AIR_EVACUATION_PIN, AIR_EVACUATION_ACTIVE); } // Turn ON
|
||||||
|
|
||||||
void SpindleLaser::air_evac_disable() { WRITE(AIR_EVACUATION_PIN, !AIR_EVACUATION_ACTIVE); } // Turn OFF
|
void SpindleLaser::air_evac_disable() { WRITE(AIR_EVACUATION_PIN, !AIR_EVACUATION_ACTIVE); } // Turn OFF
|
||||||
|
|
||||||
void SpindleLaser::air_evac_toggle() { TOGGLE(AIR_EVACUATION_PIN); } // Toggle state
|
void SpindleLaser::air_evac_toggle() { TOGGLE(AIR_EVACUATION_PIN); } // Toggle state
|
||||||
|
#endif
|
||||||
#endif // AIR_EVACUATION
|
|
||||||
|
|
||||||
#if ENABLED(AIR_ASSIST)
|
#if ENABLED(AIR_ASSIST)
|
||||||
|
|
||||||
// Enable / disable air assist
|
// Enable / disable air assist
|
||||||
void SpindleLaser::air_assist_enable() { WRITE(AIR_ASSIST_PIN, AIR_ASSIST_PIN); } // Turn ON
|
void SpindleLaser::air_assist_enable() { WRITE(AIR_ASSIST_PIN, AIR_ASSIST_PIN); } // Turn ON
|
||||||
|
|
||||||
void SpindleLaser::air_assist_disable() { WRITE(AIR_ASSIST_PIN, !AIR_ASSIST_PIN); } // Turn OFF
|
void SpindleLaser::air_assist_disable() { WRITE(AIR_ASSIST_PIN, !AIR_ASSIST_PIN); } // Turn OFF
|
||||||
|
|
||||||
void SpindleLaser::air_assist_toggle() { TOGGLE(AIR_ASSIST_PIN); } // Toggle state
|
void SpindleLaser::air_assist_toggle() { TOGGLE(AIR_ASSIST_PIN); } // Toggle state
|
||||||
|
#endif
|
||||||
#endif // AIR_ASSIST
|
|
||||||
|
|
||||||
#endif // HAS_CUTTER
|
#endif // HAS_CUTTER
|
||||||
|
@ -132,54 +132,50 @@ public:
|
|||||||
public:
|
public:
|
||||||
|
|
||||||
static void set_ocr(const uint8_t ocr);
|
static void set_ocr(const uint8_t ocr);
|
||||||
static inline void set_ocr_power(const uint8_t ocr) { power = ocr; set_ocr(ocr); }
|
static inline void ocr_set_power(const uint8_t ocr) { power = ocr; set_ocr(ocr); }
|
||||||
static void ocr_off();
|
static void ocr_off();
|
||||||
// Used to update output for power->OCR translation
|
|
||||||
|
/**
|
||||||
|
* Update output for power->OCR translation
|
||||||
|
*/
|
||||||
static inline uint8_t upower_to_ocr(const cutter_power_t upwr) {
|
static inline uint8_t upower_to_ocr(const cutter_power_t upwr) {
|
||||||
return (
|
return uint8_t(
|
||||||
#if CUTTER_UNIT_IS(PWM255)
|
#if CUTTER_UNIT_IS(PWM255)
|
||||||
uint8_t(upwr)
|
upwr
|
||||||
#elif CUTTER_UNIT_IS(PERCENT)
|
#elif CUTTER_UNIT_IS(PERCENT)
|
||||||
pct_to_ocr(upwr)
|
pct_to_ocr(upwr)
|
||||||
#else
|
#else
|
||||||
uint8_t(pct_to_ocr(cpwr_to_pct(upwr)))
|
pct_to_ocr(cpwr_to_pct(upwr))
|
||||||
#endif
|
#endif
|
||||||
);
|
);
|
||||||
}
|
}
|
||||||
|
|
||||||
// Correct power to configured range
|
/**
|
||||||
|
* Correct power to configured range
|
||||||
|
*/
|
||||||
static inline cutter_power_t power_to_range(const cutter_power_t pwr) {
|
static inline cutter_power_t power_to_range(const cutter_power_t pwr) {
|
||||||
return power_to_range(pwr, (
|
return power_to_range(pwr, _CUTTER_POWER(CUTTER_POWER_UNIT));
|
||||||
#if CUTTER_UNIT_IS(PWM255)
|
|
||||||
0
|
|
||||||
#elif CUTTER_UNIT_IS(PERCENT)
|
|
||||||
1
|
|
||||||
#elif CUTTER_UNIT_IS(RPM)
|
|
||||||
2
|
|
||||||
#else
|
|
||||||
#error "CUTTER_UNIT_IS(unknown)"
|
|
||||||
#endif
|
|
||||||
));
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static inline cutter_power_t power_to_range(const cutter_power_t pwr, const uint8_t pwrUnit) {
|
static inline cutter_power_t power_to_range(const cutter_power_t pwr, const uint8_t pwrUnit) {
|
||||||
if (pwr <= 0) return 0;
|
if (pwr <= 0) return 0;
|
||||||
cutter_power_t upwr;
|
cutter_power_t upwr;
|
||||||
switch (pwrUnit) {
|
switch (pwrUnit) {
|
||||||
case 0: // PWM
|
case _CUTTER_POWER_PWM255:
|
||||||
upwr = cutter_power_t(
|
upwr = cutter_power_t(
|
||||||
(pwr < pct_to_ocr(min_pct)) ? pct_to_ocr(min_pct) // Use minimum if set below
|
(pwr < pct_to_ocr(min_pct)) ? pct_to_ocr(min_pct) // Use minimum if set below
|
||||||
: (pwr > pct_to_ocr(max_pct)) ? pct_to_ocr(max_pct) // Use maximum if set above
|
: (pwr > pct_to_ocr(max_pct)) ? pct_to_ocr(max_pct) // Use maximum if set above
|
||||||
: pwr
|
: pwr
|
||||||
);
|
);
|
||||||
break;
|
break;
|
||||||
case 1: // PERCENT
|
case _CUTTER_POWER_PERCENT:
|
||||||
upwr = cutter_power_t(
|
upwr = cutter_power_t(
|
||||||
(pwr < min_pct) ? min_pct // Use minimum if set below
|
(pwr < min_pct) ? min_pct // Use minimum if set below
|
||||||
: (pwr > max_pct) ? max_pct // Use maximum if set above
|
: (pwr > max_pct) ? max_pct // Use maximum if set above
|
||||||
: pwr // PCT
|
: pwr // PCT
|
||||||
);
|
);
|
||||||
break;
|
break;
|
||||||
case 2: // RPM
|
case _CUTTER_POWER_RPM:
|
||||||
upwr = cutter_power_t(
|
upwr = cutter_power_t(
|
||||||
(pwr < SPEED_POWER_MIN) ? SPEED_POWER_MIN // Use minimum if set below
|
(pwr < SPEED_POWER_MIN) ? SPEED_POWER_MIN // Use minimum if set below
|
||||||
: (pwr > SPEED_POWER_MAX) ? SPEED_POWER_MAX // Use maximum if set above
|
: (pwr > SPEED_POWER_MAX) ? SPEED_POWER_MAX // Use maximum if set above
|
||||||
@ -190,14 +186,34 @@ public:
|
|||||||
}
|
}
|
||||||
return upwr;
|
return upwr;
|
||||||
}
|
}
|
||||||
|
|
||||||
#endif // SPINDLE_LASER_PWM
|
#endif // SPINDLE_LASER_PWM
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Enable/Disable spindle/laser
|
||||||
|
* @param enable true = enable; false = disable
|
||||||
|
*/
|
||||||
static inline void set_enabled(const bool enable) {
|
static inline void set_enabled(const bool enable) {
|
||||||
set_power(enable ? TERN(SPINDLE_LASER_PWM, (power ?: (unitPower ? upower_to_ocr(cpwr_to_upwr(SPEED_POWER_STARTUP)) : 0)), 255) : 0);
|
uint8_t value = 0;
|
||||||
|
if (enable) {
|
||||||
|
#if ENABLED(SPINDLE_LASER_PWM)
|
||||||
|
if (power)
|
||||||
|
value = power;
|
||||||
|
else if (unitPower)
|
||||||
|
value = upower_to_ocr(cpwr_to_upwr(SPEED_POWER_STARTUP));
|
||||||
|
#else
|
||||||
|
value = 255;
|
||||||
|
#endif
|
||||||
|
}
|
||||||
|
set_power(value);
|
||||||
}
|
}
|
||||||
|
|
||||||
// Wait for spindle to spin up or spin down
|
static inline void disable() { isReady = false; set_enabled(false); }
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Wait for spindle to spin up or spin down
|
||||||
|
*
|
||||||
|
* @param on true = state to on; false = state to off.
|
||||||
|
*/
|
||||||
static inline void power_delay(const bool on) {
|
static inline void power_delay(const bool on) {
|
||||||
#if DISABLED(LASER_POWER_INLINE)
|
#if DISABLED(LASER_POWER_INLINE)
|
||||||
safe_delay(on ? SPINDLE_LASER_POWERUP_DELAY : SPINDLE_LASER_POWERDOWN_DELAY);
|
safe_delay(on ? SPINDLE_LASER_POWERUP_DELAY : SPINDLE_LASER_POWERDOWN_DELAY);
|
||||||
@ -230,8 +246,6 @@ public:
|
|||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
static inline void disable() { isReady = false; set_enabled(false); }
|
|
||||||
|
|
||||||
#if HAS_LCD_MENU
|
#if HAS_LCD_MENU
|
||||||
static inline void enable_with_dir(const bool reverse) {
|
static inline void enable_with_dir(const bool reverse) {
|
||||||
isReady = true;
|
isReady = true;
|
||||||
@ -325,7 +339,7 @@ public:
|
|||||||
planner.laser_inline.power = ocrpwr;
|
planner.laser_inline.power = ocrpwr;
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
#endif // LASER_POWER_INLINE
|
#endif // LASER_POWER_INLINE
|
||||||
|
|
||||||
static inline void kill() {
|
static inline void kill() {
|
||||||
TERN_(LASER_POWER_INLINE, inline_disable());
|
TERN_(LASER_POWER_INLINE, inline_disable());
|
||||||
|
@ -108,7 +108,7 @@ void GcodeSuite::M3_M4(const bool is_M4) {
|
|||||||
#if ENABLED(SPINDLE_LASER_PWM)
|
#if ENABLED(SPINDLE_LASER_PWM)
|
||||||
if (parser.seenval('O')) {
|
if (parser.seenval('O')) {
|
||||||
cutter.unitPower = cutter.power_to_range(parser.value_byte(), 0);
|
cutter.unitPower = cutter.power_to_range(parser.value_byte(), 0);
|
||||||
cutter.set_ocr_power(cutter.unitPower); // The OCR is a value from 0 to 255 (uint8_t)
|
cutter.ocr_set_power(cutter.unitPower); // The OCR is a value from 0 to 255 (uint8_t)
|
||||||
}
|
}
|
||||||
else
|
else
|
||||||
cutter.set_power(cutter.upower_to_ocr(get_s_power()));
|
cutter.set_power(cutter.upower_to_ocr(get_s_power()));
|
||||||
|
@ -1914,7 +1914,7 @@ uint32_t Stepper::block_phase_isr() {
|
|||||||
laser_trap.acc_step_count += current_block->laser.entry_per;
|
laser_trap.acc_step_count += current_block->laser.entry_per;
|
||||||
if (laser_trap.cur_power < current_block->laser.power) laser_trap.cur_power++;
|
if (laser_trap.cur_power < current_block->laser.power) laser_trap.cur_power++;
|
||||||
}
|
}
|
||||||
cutter.set_ocr_power(laser_trap.cur_power);
|
cutter.ocr_set_power(laser_trap.cur_power);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
#else
|
#else
|
||||||
@ -1923,7 +1923,7 @@ uint32_t Stepper::block_phase_isr() {
|
|||||||
else {
|
else {
|
||||||
laser_trap.till_update = LASER_POWER_INLINE_TRAPEZOID_CONT_PER;
|
laser_trap.till_update = LASER_POWER_INLINE_TRAPEZOID_CONT_PER;
|
||||||
laser_trap.cur_power = (current_block->laser.power * acc_step_rate) / current_block->nominal_rate;
|
laser_trap.cur_power = (current_block->laser.power * acc_step_rate) / current_block->nominal_rate;
|
||||||
cutter.set_ocr_power(laser_trap.cur_power); // Cycle efficiency is irrelevant it the last line was many cycles
|
cutter.ocr_set_power(laser_trap.cur_power); // Cycle efficiency is irrelevant it the last line was many cycles
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
}
|
}
|
||||||
@ -1991,7 +1991,7 @@ uint32_t Stepper::block_phase_isr() {
|
|||||||
laser_trap.acc_step_count += current_block->laser.exit_per;
|
laser_trap.acc_step_count += current_block->laser.exit_per;
|
||||||
if (laser_trap.cur_power > current_block->laser.power_exit) laser_trap.cur_power--;
|
if (laser_trap.cur_power > current_block->laser.power_exit) laser_trap.cur_power--;
|
||||||
}
|
}
|
||||||
cutter.set_ocr_power(laser_trap.cur_power);
|
cutter.ocr_set_power(laser_trap.cur_power);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
#else
|
#else
|
||||||
@ -2000,7 +2000,7 @@ uint32_t Stepper::block_phase_isr() {
|
|||||||
else {
|
else {
|
||||||
laser_trap.till_update = LASER_POWER_INLINE_TRAPEZOID_CONT_PER;
|
laser_trap.till_update = LASER_POWER_INLINE_TRAPEZOID_CONT_PER;
|
||||||
laser_trap.cur_power = (current_block->laser.power * step_rate) / current_block->nominal_rate;
|
laser_trap.cur_power = (current_block->laser.power * step_rate) / current_block->nominal_rate;
|
||||||
cutter.set_ocr_power(laser_trap.cur_power); // Cycle efficiency isn't relevant when the last line was many cycles
|
cutter.ocr_set_power(laser_trap.cur_power); // Cycle efficiency isn't relevant when the last line was many cycles
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
}
|
}
|
||||||
@ -2028,7 +2028,7 @@ uint32_t Stepper::block_phase_isr() {
|
|||||||
if (laser_trap.enabled) {
|
if (laser_trap.enabled) {
|
||||||
if (!laser_trap.cruise_set) {
|
if (!laser_trap.cruise_set) {
|
||||||
laser_trap.cur_power = current_block->laser.power;
|
laser_trap.cur_power = current_block->laser.power;
|
||||||
cutter.set_ocr_power(laser_trap.cur_power);
|
cutter.ocr_set_power(laser_trap.cur_power);
|
||||||
laser_trap.cruise_set = true;
|
laser_trap.cruise_set = true;
|
||||||
}
|
}
|
||||||
#if ENABLED(LASER_POWER_INLINE_TRAPEZOID_CONT)
|
#if ENABLED(LASER_POWER_INLINE_TRAPEZOID_CONT)
|
||||||
@ -2249,14 +2249,14 @@ uint32_t Stepper::block_phase_isr() {
|
|||||||
#endif
|
#endif
|
||||||
// Always have PWM in this case
|
// Always have PWM in this case
|
||||||
if (stat.isPlanned) { // Planner controls the laser
|
if (stat.isPlanned) { // Planner controls the laser
|
||||||
cutter.set_ocr_power(
|
cutter.ocr_set_power(
|
||||||
stat.isEnabled ? laser_trap.cur_power : 0 // ON with power or OFF
|
stat.isEnabled ? laser_trap.cur_power : 0 // ON with power or OFF
|
||||||
);
|
);
|
||||||
}
|
}
|
||||||
#else
|
#else
|
||||||
if (stat.isPlanned) { // Planner controls the laser
|
if (stat.isPlanned) { // Planner controls the laser
|
||||||
#if ENABLED(SPINDLE_LASER_PWM)
|
#if ENABLED(SPINDLE_LASER_PWM)
|
||||||
cutter.set_ocr_power(
|
cutter.ocr_set_power(
|
||||||
stat.isEnabled ? current_block->laser.power : 0 // ON with power or OFF
|
stat.isEnabled ? current_block->laser.power : 0 // ON with power or OFF
|
||||||
);
|
);
|
||||||
#else
|
#else
|
||||||
@ -2304,7 +2304,7 @@ uint32_t Stepper::block_phase_isr() {
|
|||||||
const power_status_t stat = planner.laser_inline.status;
|
const power_status_t stat = planner.laser_inline.status;
|
||||||
if (stat.isPlanned) { // Planner controls the laser
|
if (stat.isPlanned) { // Planner controls the laser
|
||||||
#if ENABLED(SPINDLE_LASER_PWM)
|
#if ENABLED(SPINDLE_LASER_PWM)
|
||||||
cutter.set_ocr_power(
|
cutter.ocr_set_power(
|
||||||
stat.isEnabled ? planner.laser_inline.power : 0 // ON with power or OFF
|
stat.isEnabled ? planner.laser_inline.power : 0 // ON with power or OFF
|
||||||
);
|
);
|
||||||
#else
|
#else
|
||||||
|
@ -23,9 +23,9 @@
|
|||||||
|
|
||||||
/**
|
/**
|
||||||
* Protoneer v3.00 pin assignments
|
* Protoneer v3.00 pin assignments
|
||||||
*
|
*
|
||||||
* This CNC shield has an UNO pinout and fits all Arduino-compatibles.
|
* This CNC shield has an UNO pinout and fits all Arduino-compatibles.
|
||||||
*
|
*
|
||||||
* Referenced docs:
|
* Referenced docs:
|
||||||
* - https://blog.protoneer.co.nz/arduino-cnc-shield-v3-00-assembly-guide/
|
* - https://blog.protoneer.co.nz/arduino-cnc-shield-v3-00-assembly-guide/
|
||||||
* - https://blog.protoneer.co.nz/arduino-cnc-shield/
|
* - https://blog.protoneer.co.nz/arduino-cnc-shield/
|
||||||
|
Loading…
Reference in New Issue
Block a user