|
@@ -27,6 +27,8 @@
|
27
|
27
|
#include "../gcode.h"
|
28
|
28
|
#include "../../module/stepper.h"
|
29
|
29
|
|
|
30
|
+uint8_t spindle_laser_power; // = 0
|
|
31
|
+
|
30
|
32
|
/**
|
31
|
33
|
* M3: Spindle Clockwise
|
32
|
34
|
* M4: Spindle Counter-clockwise
|
|
@@ -59,10 +61,10 @@
|
59
|
61
|
*/
|
60
|
62
|
|
61
|
63
|
// Wait for spindle to come up to speed
|
62
|
|
-inline void delay_for_power_up() { gcode.dwell(SPINDLE_LASER_POWERUP_DELAY); }
|
|
64
|
+inline void delay_for_power_up() { safe_delay(SPINDLE_LASER_POWERUP_DELAY); }
|
63
|
65
|
|
64
|
66
|
// Wait for spindle to stop turning
|
65
|
|
-inline void delay_for_power_down() { gcode.dwell(SPINDLE_LASER_POWERDOWN_DELAY); }
|
|
67
|
+inline void delay_for_power_down() { safe_delay(SPINDLE_LASER_POWERDOWN_DELAY); }
|
66
|
68
|
|
67
|
69
|
/**
|
68
|
70
|
* ocr_val_mode() is used for debugging and to get the points needed to compute the RPM vs ocr_val line
|
|
@@ -70,26 +72,72 @@ inline void delay_for_power_down() { gcode.dwell(SPINDLE_LASER_POWERDOWN_DELAY);
|
70
|
72
|
* it accepts inputs of 0-255
|
71
|
73
|
*/
|
72
|
74
|
|
73
|
|
-inline void ocr_val_mode() {
|
74
|
|
- uint8_t spindle_laser_power = parser.value_byte();
|
|
75
|
+inline void set_spindle_laser_ocr(const uint8_t ocr) {
|
75
|
76
|
WRITE(SPINDLE_LASER_ENABLE_PIN, SPINDLE_LASER_ENABLE_INVERT); // turn spindle on (active low)
|
76
|
|
- if (SPINDLE_LASER_PWM_INVERT) spindle_laser_power = 255 - spindle_laser_power;
|
77
|
|
- analogWrite(SPINDLE_LASER_PWM_PIN, spindle_laser_power);
|
|
77
|
+ analogWrite(SPINDLE_LASER_PWM_PIN, (SPINDLE_LASER_PWM_INVERT) ? 255 - ocr : ocr);
|
78
|
78
|
}
|
79
|
79
|
|
80
|
|
-void GcodeSuite::M3_M4(bool is_M3) {
|
|
80
|
+#if ENABLED(SPINDLE_LASER_PWM)
|
81
|
81
|
|
82
|
|
- planner.synchronize(); // wait until previous movement commands (G0/G0/G2/G3) have completed before playing with the spindle
|
83
|
|
- #if SPINDLE_DIR_CHANGE
|
84
|
|
- const bool rotation_dir = (is_M3 != SPINDLE_INVERT_DIR);
|
85
|
|
- if (SPINDLE_STOP_ON_DIR_CHANGE \
|
86
|
|
- && READ(SPINDLE_LASER_ENABLE_PIN) == SPINDLE_LASER_ENABLE_INVERT \
|
87
|
|
- && READ(SPINDLE_DIR_PIN) != rotation_dir
|
88
|
|
- ) {
|
89
|
|
- WRITE(SPINDLE_LASER_ENABLE_PIN, !SPINDLE_LASER_ENABLE_INVERT); // turn spindle off
|
|
82
|
+ void update_spindle_laser_power() {
|
|
83
|
+ if (spindle_laser_power == 0) {
|
|
84
|
+ WRITE(SPINDLE_LASER_ENABLE_PIN, !SPINDLE_LASER_ENABLE_INVERT); // turn spindle off (active low)
|
|
85
|
+ analogWrite(SPINDLE_LASER_PWM_PIN, SPINDLE_LASER_PWM_INVERT ? 255 : 0); // only write low byte
|
|
86
|
+ delay_for_power_down();
|
|
87
|
+ }
|
|
88
|
+ else { // Convert RPM to PWM duty cycle
|
|
89
|
+ constexpr float inv_slope = 1.0f / (SPEED_POWER_SLOPE),
|
|
90
|
+ min_ocr = (SPEED_POWER_MIN - (SPEED_POWER_INTERCEPT)) * inv_slope, // Minimum allowed
|
|
91
|
+ max_ocr = (SPEED_POWER_MAX - (SPEED_POWER_INTERCEPT)) * inv_slope; // Maximum allowed
|
|
92
|
+ int16_t ocr_val;
|
|
93
|
+ if (spindle_laser_power <= SPEED_POWER_MIN) ocr_val = min_ocr; // Use minimum if set below
|
|
94
|
+ else if (spindle_laser_power >= SPEED_POWER_MAX) ocr_val = max_ocr; // Use maximum if set above
|
|
95
|
+ else ocr_val = (spindle_laser_power - (SPEED_POWER_INTERCEPT)) * inv_slope; // Use calculated OCR value
|
|
96
|
+ set_spindle_laser_ocr(ocr_val & 0xFF); // ...limited to Atmel PWM max
|
|
97
|
+ delay_for_power_up();
|
|
98
|
+ }
|
|
99
|
+ }
|
|
100
|
+
|
|
101
|
+#endif // SPINDLE_LASER_PWM
|
|
102
|
+
|
|
103
|
+bool spindle_laser_enabled() {
|
|
104
|
+ return !!spindle_laser_power; // READ(SPINDLE_LASER_ENABLE_PIN) == SPINDLE_LASER_ENABLE_INVERT;
|
|
105
|
+}
|
|
106
|
+
|
|
107
|
+void set_spindle_laser_enabled(const bool enable) {
|
|
108
|
+ // Enabled by PWM setting elsewhere
|
|
109
|
+ spindle_laser_power = enable ? 255 : 0;
|
|
110
|
+ #if ENABLED(SPINDLE_LASER_PWM)
|
|
111
|
+ update_spindle_laser_power();
|
|
112
|
+ #else
|
|
113
|
+ if (enable) {
|
|
114
|
+ WRITE(SPINDLE_LASER_ENABLE_PIN, SPINDLE_LASER_ENABLE_INVERT);
|
|
115
|
+ delay_for_power_up();
|
|
116
|
+ }
|
|
117
|
+ else {
|
|
118
|
+ WRITE(SPINDLE_LASER_ENABLE_PIN, !SPINDLE_LASER_ENABLE_INVERT);
|
90
|
119
|
delay_for_power_down();
|
91
|
120
|
}
|
92
|
|
- WRITE(SPINDLE_DIR_PIN, rotation_dir);
|
|
121
|
+ #endif
|
|
122
|
+}
|
|
123
|
+
|
|
124
|
+#if SPINDLE_DIR_CHANGE
|
|
125
|
+
|
|
126
|
+ void set_spindle_direction(const bool reverse_dir) {
|
|
127
|
+ const bool dir_state = (reverse_dir == SPINDLE_INVERT_DIR); // Forward (M3) HIGH when not inverted
|
|
128
|
+ if (SPINDLE_STOP_ON_DIR_CHANGE && spindle_laser_enabled() && READ(SPINDLE_DIR_PIN) != dir_state)
|
|
129
|
+ set_spindle_laser_enabled(false);
|
|
130
|
+ WRITE(SPINDLE_DIR_PIN, dir_state);
|
|
131
|
+ }
|
|
132
|
+
|
|
133
|
+#endif
|
|
134
|
+
|
|
135
|
+void GcodeSuite::M3_M4(const bool is_M4) {
|
|
136
|
+
|
|
137
|
+ planner.synchronize(); // wait until previous movement commands (G0/G0/G2/G3) have completed before playing with the spindle
|
|
138
|
+
|
|
139
|
+ #if SPINDLE_DIR_CHANGE
|
|
140
|
+ set_spindle_direction(is_M4);
|
93
|
141
|
#endif
|
94
|
142
|
|
95
|
143
|
/**
|
|
@@ -98,30 +146,16 @@ void GcodeSuite::M3_M4(bool is_M3) {
|
98
|
146
|
* Then needed to AND the uint16_t result with 0x00FF to make sure we only wrote the byte of interest.
|
99
|
147
|
*/
|
100
|
148
|
#if ENABLED(SPINDLE_LASER_PWM)
|
101
|
|
- if (parser.seen('O')) ocr_val_mode();
|
|
149
|
+ if (parser.seen('O')) {
|
|
150
|
+ spindle_laser_power = parser.value_byte();
|
|
151
|
+ set_spindle_laser_ocr(spindle_laser_power);
|
|
152
|
+ }
|
102
|
153
|
else {
|
103
|
|
- const float spindle_laser_power = parser.floatval('S');
|
104
|
|
- if (spindle_laser_power == 0) {
|
105
|
|
- WRITE(SPINDLE_LASER_ENABLE_PIN, !SPINDLE_LASER_ENABLE_INVERT); // turn spindle off (active low)
|
106
|
|
- analogWrite(SPINDLE_LASER_PWM_PIN, SPINDLE_LASER_PWM_INVERT ? 255 : 0); // only write low byte
|
107
|
|
- delay_for_power_down();
|
108
|
|
- }
|
109
|
|
- else {
|
110
|
|
- int16_t ocr_val = (spindle_laser_power - (SPEED_POWER_INTERCEPT)) * (1.0f / (SPEED_POWER_SLOPE)); // convert RPM to PWM duty cycle
|
111
|
|
- NOMORE(ocr_val, 255); // limit to max the Atmel PWM will support
|
112
|
|
- if (spindle_laser_power <= SPEED_POWER_MIN)
|
113
|
|
- ocr_val = (SPEED_POWER_MIN - (SPEED_POWER_INTERCEPT)) * (1.0f / (SPEED_POWER_SLOPE)); // minimum setting
|
114
|
|
- if (spindle_laser_power >= SPEED_POWER_MAX)
|
115
|
|
- ocr_val = (SPEED_POWER_MAX - (SPEED_POWER_INTERCEPT)) * (1.0f / (SPEED_POWER_SLOPE)); // limit to max RPM
|
116
|
|
- if (SPINDLE_LASER_PWM_INVERT) ocr_val = 255 - ocr_val;
|
117
|
|
- WRITE(SPINDLE_LASER_ENABLE_PIN, SPINDLE_LASER_ENABLE_INVERT); // turn spindle on (active low)
|
118
|
|
- analogWrite(SPINDLE_LASER_PWM_PIN, ocr_val & 0xFF); // only write low byte
|
119
|
|
- delay_for_power_up();
|
120
|
|
- }
|
|
154
|
+ spindle_laser_power = parser.intval('S', 255);
|
|
155
|
+ update_spindle_laser_power();
|
121
|
156
|
}
|
122
|
157
|
#else
|
123
|
|
- WRITE(SPINDLE_LASER_ENABLE_PIN, SPINDLE_LASER_ENABLE_INVERT); // turn spindle on (active low) if spindle speed option not enabled
|
124
|
|
- delay_for_power_up();
|
|
158
|
+ set_spindle_laser_enabled(true);
|
125
|
159
|
#endif
|
126
|
160
|
}
|
127
|
161
|
|
|
@@ -130,11 +164,7 @@ void GcodeSuite::M3_M4(bool is_M3) {
|
130
|
164
|
*/
|
131
|
165
|
void GcodeSuite::M5() {
|
132
|
166
|
planner.synchronize();
|
133
|
|
- WRITE(SPINDLE_LASER_ENABLE_PIN, !SPINDLE_LASER_ENABLE_INVERT);
|
134
|
|
- #if ENABLED(SPINDLE_LASER_PWM)
|
135
|
|
- analogWrite(SPINDLE_LASER_PWM_PIN, SPINDLE_LASER_PWM_INVERT ? 255 : 0);
|
136
|
|
- #endif
|
137
|
|
- delay_for_power_down();
|
|
167
|
+ set_spindle_laser_enabled(false);
|
138
|
168
|
}
|
139
|
169
|
|
140
|
170
|
#endif // SPINDLE_LASER_ENABLE
|