diff options
Diffstat (limited to 'quantum/audio/driver_avr_pwm_hardware.c')
-rw-r--r-- | quantum/audio/driver_avr_pwm_hardware.c | 332 |
1 files changed, 0 insertions, 332 deletions
diff --git a/quantum/audio/driver_avr_pwm_hardware.c b/quantum/audio/driver_avr_pwm_hardware.c deleted file mode 100644 index df03a4558..000000000 --- a/quantum/audio/driver_avr_pwm_hardware.c +++ /dev/null | |||
@@ -1,332 +0,0 @@ | |||
1 | /* Copyright 2016 Jack Humbert | ||
2 | * Copyright 2020 JohSchneider | ||
3 | * | ||
4 | * This program is free software: you can redistribute it and/or modify | ||
5 | * it under the terms of the GNU General Public License as published by | ||
6 | * the Free Software Foundation, either version 2 of the License, or | ||
7 | * (at your option) any later version. | ||
8 | * | ||
9 | * This program is distributed in the hope that it will be useful, | ||
10 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
11 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
12 | * GNU General Public License for more details. | ||
13 | * | ||
14 | * You should have received a copy of the GNU General Public License | ||
15 | * along with this program. If not, see <http://www.gnu.org/licenses/>. | ||
16 | */ | ||
17 | |||
18 | #if defined(__AVR__) | ||
19 | # include <avr/pgmspace.h> | ||
20 | # include <avr/interrupt.h> | ||
21 | # include <avr/io.h> | ||
22 | #endif | ||
23 | |||
24 | #include "audio.h" | ||
25 | |||
26 | extern bool playing_note; | ||
27 | extern bool playing_melody; | ||
28 | extern uint8_t note_timbre; | ||
29 | |||
30 | #define CPU_PRESCALER 8 | ||
31 | |||
32 | /* | ||
33 | Audio Driver: PWM | ||
34 | |||
35 | drive up to two speakers through the AVR PWM hardware-peripheral, using timer1 and/or timer3 on Atmega32U4. | ||
36 | |||
37 | the primary channel_1 can be connected to either pin PC4 PC5 or PC6 (the later being used by most AVR based keyboards) with a PMW signal generated by timer3 | ||
38 | and an optional secondary channel_2 on either pin PB5, PB6 or PB7, with a PWM signal from timer1 | ||
39 | |||
40 | alternatively, the PWM pins on PORTB can be used as only/primary speaker | ||
41 | */ | ||
42 | |||
43 | #if defined(AUDIO_PIN) && (AUDIO_PIN != C4) && (AUDIO_PIN != C5) && (AUDIO_PIN != C6) && (AUDIO_PIN != B5) && (AUDIO_PIN != B6) && (AUDIO_PIN != B7) && (AUDIO_PIN != D5) | ||
44 | # error "Audio feature enabled, but no suitable pin selected as AUDIO_PIN - see docs/feature_audio under the AVR settings for available options." | ||
45 | #endif | ||
46 | |||
47 | #if (AUDIO_PIN == C4) || (AUDIO_PIN == C5) || (AUDIO_PIN == C6) | ||
48 | # define AUDIO1_PIN_SET | ||
49 | # define AUDIO1_TIMSKx TIMSK3 | ||
50 | # define AUDIO1_TCCRxA TCCR3A | ||
51 | # define AUDIO1_TCCRxB TCCR3B | ||
52 | # define AUDIO1_ICRx ICR3 | ||
53 | # define AUDIO1_WGMx0 WGM30 | ||
54 | # define AUDIO1_WGMx1 WGM31 | ||
55 | # define AUDIO1_WGMx2 WGM32 | ||
56 | # define AUDIO1_WGMx3 WGM33 | ||
57 | # define AUDIO1_CSx0 CS30 | ||
58 | # define AUDIO1_CSx1 CS31 | ||
59 | # define AUDIO1_CSx2 CS32 | ||
60 | |||
61 | # if (AUDIO_PIN == C6) | ||
62 | # define AUDIO1_COMxy0 COM3A0 | ||
63 | # define AUDIO1_COMxy1 COM3A1 | ||
64 | # define AUDIO1_OCIExy OCIE3A | ||
65 | # define AUDIO1_OCRxy OCR3A | ||
66 | # define AUDIO1_PIN C6 | ||
67 | # define AUDIO1_TIMERx_COMPy_vect TIMER3_COMPA_vect | ||
68 | # elif (AUDIO_PIN == C5) | ||
69 | # define AUDIO1_COMxy0 COM3B0 | ||
70 | # define AUDIO1_COMxy1 COM3B1 | ||
71 | # define AUDIO1_OCIExy OCIE3B | ||
72 | # define AUDIO1_OCRxy OCR3B | ||
73 | # define AUDIO1_PIN C5 | ||
74 | # define AUDIO1_TIMERx_COMPy_vect TIMER3_COMPB_vect | ||
75 | # elif (AUDIO_PIN == C4) | ||
76 | # define AUDIO1_COMxy0 COM3C0 | ||
77 | # define AUDIO1_COMxy1 COM3C1 | ||
78 | # define AUDIO1_OCIExy OCIE3C | ||
79 | # define AUDIO1_OCRxy OCR3C | ||
80 | # define AUDIO1_PIN C4 | ||
81 | # define AUDIO1_TIMERx_COMPy_vect TIMER3_COMPC_vect | ||
82 | # endif | ||
83 | #endif | ||
84 | |||
85 | #if defined(AUDIO_PIN) && defined(AUDIO_PIN_ALT) && (AUDIO_PIN == AUDIO_PIN_ALT) | ||
86 | # error "Audio feature: AUDIO_PIN and AUDIO_PIN_ALT on the same pin makes no sense." | ||
87 | #endif | ||
88 | |||
89 | #if ((AUDIO_PIN == B5) && ((AUDIO_PIN_ALT == B6) || (AUDIO_PIN_ALT == B7))) || ((AUDIO_PIN == B6) && ((AUDIO_PIN_ALT == B5) || (AUDIO_PIN_ALT == B7))) || ((AUDIO_PIN == B7) && ((AUDIO_PIN_ALT == B5) || (AUDIO_PIN_ALT == B6))) | ||
90 | # error "Audio feature: PORTB as AUDIO_PIN and AUDIO_PIN_ALT at the same time is not supported." | ||
91 | #endif | ||
92 | |||
93 | #if defined(AUDIO_PIN_ALT) && (AUDIO_PIN_ALT != B5) && (AUDIO_PIN_ALT != B6) && (AUDIO_PIN_ALT != B7) | ||
94 | # error "Audio feature: the pin selected as AUDIO_PIN_ALT is not supported." | ||
95 | #endif | ||
96 | |||
97 | #if (AUDIO_PIN == B5) || (AUDIO_PIN == B6) || (AUDIO_PIN == B7) || (AUDIO_PIN_ALT == B5) || (AUDIO_PIN_ALT == B6) || (AUDIO_PIN_ALT == B7) || (AUDIO_PIN == D5) | ||
98 | # define AUDIO2_PIN_SET | ||
99 | # define AUDIO2_TIMSKx TIMSK1 | ||
100 | # define AUDIO2_TCCRxA TCCR1A | ||
101 | # define AUDIO2_TCCRxB TCCR1B | ||
102 | # define AUDIO2_ICRx ICR1 | ||
103 | # define AUDIO2_WGMx0 WGM10 | ||
104 | # define AUDIO2_WGMx1 WGM11 | ||
105 | # define AUDIO2_WGMx2 WGM12 | ||
106 | # define AUDIO2_WGMx3 WGM13 | ||
107 | # define AUDIO2_CSx0 CS10 | ||
108 | # define AUDIO2_CSx1 CS11 | ||
109 | # define AUDIO2_CSx2 CS12 | ||
110 | |||
111 | # if (AUDIO_PIN == B5) || (AUDIO_PIN_ALT == B5) | ||
112 | # define AUDIO2_COMxy0 COM1A0 | ||
113 | # define AUDIO2_COMxy1 COM1A1 | ||
114 | # define AUDIO2_OCIExy OCIE1A | ||
115 | # define AUDIO2_OCRxy OCR1A | ||
116 | # define AUDIO2_PIN B5 | ||
117 | # define AUDIO2_TIMERx_COMPy_vect TIMER1_COMPA_vect | ||
118 | # elif (AUDIO_PIN == B6) || (AUDIO_PIN_ALT == B6) | ||
119 | # define AUDIO2_COMxy0 COM1B0 | ||
120 | # define AUDIO2_COMxy1 COM1B1 | ||
121 | # define AUDIO2_OCIExy OCIE1B | ||
122 | # define AUDIO2_OCRxy OCR1B | ||
123 | # define AUDIO2_PIN B6 | ||
124 | # define AUDIO2_TIMERx_COMPy_vect TIMER1_COMPB_vect | ||
125 | # elif (AUDIO_PIN == B7) || (AUDIO_PIN_ALT == B7) | ||
126 | # define AUDIO2_COMxy0 COM1C0 | ||
127 | # define AUDIO2_COMxy1 COM1C1 | ||
128 | # define AUDIO2_OCIExy OCIE1C | ||
129 | # define AUDIO2_OCRxy OCR1C | ||
130 | # define AUDIO2_PIN B7 | ||
131 | # define AUDIO2_TIMERx_COMPy_vect TIMER1_COMPC_vect | ||
132 | # elif (AUDIO_PIN == D5) && defined(__AVR_ATmega32A__) | ||
133 | # pragma message "Audio support for ATmega32A is experimental and can cause crashes." | ||
134 | # undef AUDIO2_TIMSKx | ||
135 | # define AUDIO2_TIMSKx TIMSK | ||
136 | # define AUDIO2_COMxy0 COM1A0 | ||
137 | # define AUDIO2_COMxy1 COM1A1 | ||
138 | # define AUDIO2_OCIExy OCIE1A | ||
139 | # define AUDIO2_OCRxy OCR1A | ||
140 | # define AUDIO2_PIN D5 | ||
141 | # define AUDIO2_TIMERx_COMPy_vect TIMER1_COMPA_vect | ||
142 | # endif | ||
143 | #endif | ||
144 | |||
145 | // C6 seems to be the assumed default by many existing keyboard - but sill warn the user | ||
146 | #if !defined(AUDIO1_PIN_SET) && !defined(AUDIO2_PIN_SET) | ||
147 | # pragma message "Audio feature enabled, but no suitable pin selected - see docs/feature_audio under the AVR settings for available options. Don't expect to hear anything... :-)" | ||
148 | // TODO: make this an error - go through the breaking-change-process and change all keyboards to the new define | ||
149 | #endif | ||
150 | // ----------------------------------------------------------------------------- | ||
151 | |||
152 | #ifdef AUDIO1_PIN_SET | ||
153 | static float channel_1_frequency = 0.0f; | ||
154 | void channel_1_set_frequency(float freq) { | ||
155 | if (freq == 0.0f) // a pause/rest is a valid "note" with freq=0 | ||
156 | { | ||
157 | // disable the output, but keep the pwm-ISR going (with the previous | ||
158 | // frequency) so the audio-state keeps getting updated | ||
159 | // Note: setting the duty-cycle 0 is not possible on non-inverting PWM mode - see the AVR data-sheet | ||
160 | AUDIO1_TCCRxA &= ~(_BV(AUDIO1_COMxy1) | _BV(AUDIO1_COMxy0)); | ||
161 | return; | ||
162 | } else { | ||
163 | AUDIO1_TCCRxA |= _BV(AUDIO1_COMxy1); // enable output, PWM mode | ||
164 | } | ||
165 | |||
166 | channel_1_frequency = freq; | ||
167 | |||
168 | // set pwm period | ||
169 | AUDIO1_ICRx = (uint16_t)(((float)F_CPU) / (freq * CPU_PRESCALER)); | ||
170 | // and duty cycle | ||
171 | AUDIO1_OCRxy = (uint16_t)((((float)F_CPU) / (freq * CPU_PRESCALER)) * note_timbre / 100); | ||
172 | } | ||
173 | |||
174 | void channel_1_start(void) { | ||
175 | // enable timer-counter ISR | ||
176 | AUDIO1_TIMSKx |= _BV(AUDIO1_OCIExy); | ||
177 | // enable timer-counter output | ||
178 | AUDIO1_TCCRxA |= _BV(AUDIO1_COMxy1); | ||
179 | } | ||
180 | |||
181 | void channel_1_stop(void) { | ||
182 | // disable timer-counter ISR | ||
183 | AUDIO1_TIMSKx &= ~_BV(AUDIO1_OCIExy); | ||
184 | // disable timer-counter output | ||
185 | AUDIO1_TCCRxA &= ~(_BV(AUDIO1_COMxy1) | _BV(AUDIO1_COMxy0)); | ||
186 | } | ||
187 | #endif | ||
188 | |||
189 | #ifdef AUDIO2_PIN_SET | ||
190 | static float channel_2_frequency = 0.0f; | ||
191 | void channel_2_set_frequency(float freq) { | ||
192 | if (freq == 0.0f) { | ||
193 | AUDIO2_TCCRxA &= ~(_BV(AUDIO2_COMxy1) | _BV(AUDIO2_COMxy0)); | ||
194 | return; | ||
195 | } else { | ||
196 | AUDIO2_TCCRxA |= _BV(AUDIO2_COMxy1); | ||
197 | } | ||
198 | |||
199 | channel_2_frequency = freq; | ||
200 | |||
201 | AUDIO2_ICRx = (uint16_t)(((float)F_CPU) / (freq * CPU_PRESCALER)); | ||
202 | AUDIO2_OCRxy = (uint16_t)((((float)F_CPU) / (freq * CPU_PRESCALER)) * note_timbre / 100); | ||
203 | } | ||
204 | |||
205 | float channel_2_get_frequency(void) { return channel_2_frequency; } | ||
206 | |||
207 | void channel_2_start(void) { | ||
208 | AUDIO2_TIMSKx |= _BV(AUDIO2_OCIExy); | ||
209 | AUDIO2_TCCRxA |= _BV(AUDIO2_COMxy1); | ||
210 | } | ||
211 | |||
212 | void channel_2_stop(void) { | ||
213 | AUDIO2_TIMSKx &= ~_BV(AUDIO2_OCIExy); | ||
214 | AUDIO2_TCCRxA &= ~(_BV(AUDIO2_COMxy1) | _BV(AUDIO2_COMxy0)); | ||
215 | } | ||
216 | #endif | ||
217 | |||
218 | void audio_driver_initialize() { | ||
219 | #ifdef AUDIO1_PIN_SET | ||
220 | channel_1_stop(); | ||
221 | setPinOutput(AUDIO1_PIN); | ||
222 | #endif | ||
223 | |||
224 | #ifdef AUDIO2_PIN_SET | ||
225 | channel_2_stop(); | ||
226 | setPinOutput(AUDIO2_PIN); | ||
227 | #endif | ||
228 | |||
229 | // TCCR3A / TCCR3B: Timer/Counter #3 Control Registers TCCR3A/TCCR3B, TCCR1A/TCCR1B | ||
230 | // Compare Output Mode (COM3An and COM1An) = 0b00 = Normal port operation | ||
231 | // OC3A -- PC6 | ||
232 | // OC3B -- PC5 | ||
233 | // OC3C -- PC4 | ||
234 | // OC1A -- PB5 | ||
235 | // OC1B -- PB6 | ||
236 | // OC1C -- PB7 | ||
237 | |||
238 | // Waveform Generation Mode (WGM3n) = 0b1110 = Fast PWM Mode 14. Period = ICR3, Duty Cycle OCR3A) | ||
239 | // OCR3A - PC6 | ||
240 | // OCR3B - PC5 | ||
241 | // OCR3C - PC4 | ||
242 | // OCR1A - PB5 | ||
243 | // OCR1B - PB6 | ||
244 | // OCR1C - PB7 | ||
245 | |||
246 | // Clock Select (CS3n) = 0b010 = Clock / 8 | ||
247 | #ifdef AUDIO1_PIN_SET | ||
248 | // initialize timer-counter | ||
249 | AUDIO1_TCCRxA = (0 << AUDIO1_COMxy1) | (0 << AUDIO1_COMxy0) | (1 << AUDIO1_WGMx1) | (0 << AUDIO1_WGMx0); | ||
250 | AUDIO1_TCCRxB = (1 << AUDIO1_WGMx3) | (1 << AUDIO1_WGMx2) | (0 << AUDIO1_CSx2) | (1 << AUDIO1_CSx1) | (0 << AUDIO1_CSx0); | ||
251 | #endif | ||
252 | |||
253 | #ifdef AUDIO2_PIN_SET | ||
254 | AUDIO2_TCCRxA = (0 << AUDIO2_COMxy1) | (0 << AUDIO2_COMxy0) | (1 << AUDIO2_WGMx1) | (0 << AUDIO2_WGMx0); | ||
255 | AUDIO2_TCCRxB = (1 << AUDIO2_WGMx3) | (1 << AUDIO2_WGMx2) | (0 << AUDIO2_CSx2) | (1 << AUDIO2_CSx1) | (0 << AUDIO2_CSx0); | ||
256 | #endif | ||
257 | } | ||
258 | |||
259 | void audio_driver_stop() { | ||
260 | #ifdef AUDIO1_PIN_SET | ||
261 | channel_1_stop(); | ||
262 | #endif | ||
263 | |||
264 | #ifdef AUDIO2_PIN_SET | ||
265 | channel_2_stop(); | ||
266 | #endif | ||
267 | } | ||
268 | |||
269 | void audio_driver_start(void) { | ||
270 | #ifdef AUDIO1_PIN_SET | ||
271 | channel_1_start(); | ||
272 | if (playing_note) { | ||
273 | channel_1_set_frequency(audio_get_processed_frequency(0)); | ||
274 | } | ||
275 | #endif | ||
276 | |||
277 | #if !defined(AUDIO1_PIN_SET) && defined(AUDIO2_PIN_SET) | ||
278 | channel_2_start(); | ||
279 | if (playing_note) { | ||
280 | channel_2_set_frequency(audio_get_processed_frequency(0)); | ||
281 | } | ||
282 | #endif | ||
283 | } | ||
284 | |||
285 | static volatile uint32_t isr_counter = 0; | ||
286 | #ifdef AUDIO1_PIN_SET | ||
287 | ISR(AUDIO1_TIMERx_COMPy_vect) { | ||
288 | isr_counter++; | ||
289 | if (isr_counter < channel_1_frequency / (CPU_PRESCALER * 8)) return; | ||
290 | |||
291 | isr_counter = 0; | ||
292 | bool state_changed = audio_update_state(); | ||
293 | |||
294 | if (!playing_note && !playing_melody) { | ||
295 | channel_1_stop(); | ||
296 | # ifdef AUDIO2_PIN_SET | ||
297 | channel_2_stop(); | ||
298 | # endif | ||
299 | return; | ||
300 | } | ||
301 | |||
302 | if (state_changed) { | ||
303 | channel_1_set_frequency(audio_get_processed_frequency(0)); | ||
304 | # ifdef AUDIO2_PIN_SET | ||
305 | if (audio_get_number_of_active_tones() > 1) { | ||
306 | channel_2_set_frequency(audio_get_processed_frequency(1)); | ||
307 | } else { | ||
308 | channel_2_stop(); | ||
309 | } | ||
310 | # endif | ||
311 | } | ||
312 | } | ||
313 | #endif | ||
314 | |||
315 | #if !defined(AUDIO1_PIN_SET) && defined(AUDIO2_PIN_SET) | ||
316 | ISR(AUDIO2_TIMERx_COMPy_vect) { | ||
317 | isr_counter++; | ||
318 | if (isr_counter < channel_2_frequency / (CPU_PRESCALER * 8)) return; | ||
319 | |||
320 | isr_counter = 0; | ||
321 | bool state_changed = audio_update_state(); | ||
322 | |||
323 | if (!playing_note && !playing_melody) { | ||
324 | channel_2_stop(); | ||
325 | return; | ||
326 | } | ||
327 | |||
328 | if (state_changed) { | ||
329 | channel_2_set_frequency(audio_get_processed_frequency(0)); | ||
330 | } | ||
331 | } | ||
332 | #endif | ||