aboutsummaryrefslogtreecommitdiff
path: root/quantum/audio/audio_chibios.c
diff options
context:
space:
mode:
Diffstat (limited to 'quantum/audio/audio_chibios.c')
-rw-r--r--quantum/audio/audio_chibios.c702
1 files changed, 702 insertions, 0 deletions
diff --git a/quantum/audio/audio_chibios.c b/quantum/audio/audio_chibios.c
new file mode 100644
index 000000000..fba7c5987
--- /dev/null
+++ b/quantum/audio/audio_chibios.c
@@ -0,0 +1,702 @@
1/* Copyright 2016 Jack Humbert
2 *
3 * This program is free software: you can redistribute it and/or modify
4 * it under the terms of the GNU General Public License as published by
5 * the Free Software Foundation, either version 2 of the License, or
6 * (at your option) any later version.
7 *
8 * This program is distributed in the hope that it will be useful,
9 * but WITHOUT ANY WARRANTY; without even the implied warranty of
10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
11 * GNU General Public License for more details.
12 *
13 * You should have received a copy of the GNU General Public License
14 * along with this program. If not, see <http://www.gnu.org/licenses/>.
15 */
16
17#include "audio.h"
18#include "ch.h"
19#include "hal.h"
20
21#include <string.h>
22#include "print.h"
23#include "keymap.h"
24
25#include "eeconfig.h"
26
27// -----------------------------------------------------------------------------
28
29int voices = 0;
30int voice_place = 0;
31float frequency = 0;
32float frequency_alt = 0;
33int volume = 0;
34long position = 0;
35
36float frequencies[8] = {0, 0, 0, 0, 0, 0, 0, 0};
37int volumes[8] = {0, 0, 0, 0, 0, 0, 0, 0};
38bool sliding = false;
39
40float place = 0;
41
42uint8_t *sample;
43uint16_t sample_length = 0;
44
45bool playing_notes = false;
46bool playing_note = false;
47float note_frequency = 0;
48float note_length = 0;
49uint8_t note_tempo = TEMPO_DEFAULT;
50float note_timbre = TIMBRE_DEFAULT;
51uint16_t note_position = 0;
52float (*notes_pointer)[][2];
53uint16_t notes_count;
54bool notes_repeat;
55bool note_resting = false;
56
57uint16_t current_note = 0;
58uint8_t rest_counter = 0;
59
60#ifdef VIBRATO_ENABLE
61float vibrato_counter = 0;
62float vibrato_strength = .5;
63float vibrato_rate = 0.125;
64#endif
65
66float polyphony_rate = 0;
67
68static bool audio_initialized = false;
69
70audio_config_t audio_config;
71
72uint16_t envelope_index = 0;
73bool glissando = true;
74
75#ifndef STARTUP_SONG
76# define STARTUP_SONG SONG(STARTUP_SOUND)
77#endif
78float startup_song[][2] = STARTUP_SONG;
79
80static void gpt_cb8(GPTDriver *gptp);
81
82#define DAC_BUFFER_SIZE 100
83#ifndef DAC_SAMPLE_MAX
84# define DAC_SAMPLE_MAX 65535U
85#endif
86
87#define START_CHANNEL_1() \
88 gptStart(&GPTD6, &gpt6cfg1); \
89 gptStartContinuous(&GPTD6, 2U)
90#define START_CHANNEL_2() \
91 gptStart(&GPTD7, &gpt7cfg1); \
92 gptStartContinuous(&GPTD7, 2U)
93#define STOP_CHANNEL_1() gptStopTimer(&GPTD6)
94#define STOP_CHANNEL_2() gptStopTimer(&GPTD7)
95#define RESTART_CHANNEL_1() \
96 STOP_CHANNEL_1(); \
97 START_CHANNEL_1()
98#define RESTART_CHANNEL_2() \
99 STOP_CHANNEL_2(); \
100 START_CHANNEL_2()
101#define UPDATE_CHANNEL_1_FREQ(freq) \
102 gpt6cfg1.frequency = freq * DAC_BUFFER_SIZE; \
103 RESTART_CHANNEL_1()
104#define UPDATE_CHANNEL_2_FREQ(freq) \
105 gpt7cfg1.frequency = freq * DAC_BUFFER_SIZE; \
106 RESTART_CHANNEL_2()
107#define GET_CHANNEL_1_FREQ (uint16_t)(gpt6cfg1.frequency * DAC_BUFFER_SIZE)
108#define GET_CHANNEL_2_FREQ (uint16_t)(gpt7cfg1.frequency * DAC_BUFFER_SIZE)
109
110/*
111 * GPT6 configuration.
112 */
113// static const GPTConfig gpt6cfg1 = {
114// .frequency = 1000000U,
115// .callback = NULL,
116// .cr2 = TIM_CR2_MMS_1, /* MMS = 010 = TRGO on Update Event. */
117// .dier = 0U
118// };
119
120GPTConfig gpt6cfg1 = {.frequency = 440U * DAC_BUFFER_SIZE,
121 .callback = NULL,
122 .cr2 = TIM_CR2_MMS_1, /* MMS = 010 = TRGO on Update Event. */
123 .dier = 0U};
124
125GPTConfig gpt7cfg1 = {.frequency = 440U * DAC_BUFFER_SIZE,
126 .callback = NULL,
127 .cr2 = TIM_CR2_MMS_1, /* MMS = 010 = TRGO on Update Event. */
128 .dier = 0U};
129
130GPTConfig gpt8cfg1 = {.frequency = 10,
131 .callback = gpt_cb8,
132 .cr2 = TIM_CR2_MMS_1, /* MMS = 010 = TRGO on Update Event. */
133 .dier = 0U};
134
135/*
136 * DAC test buffer (sine wave).
137 */
138// static const dacsample_t dac_buffer[DAC_BUFFER_SIZE] = {
139// 2047, 2082, 2118, 2154, 2189, 2225, 2260, 2296, 2331, 2367, 2402, 2437,
140// 2472, 2507, 2542, 2576, 2611, 2645, 2679, 2713, 2747, 2780, 2813, 2846,
141// 2879, 2912, 2944, 2976, 3008, 3039, 3070, 3101, 3131, 3161, 3191, 3221,
142// 3250, 3278, 3307, 3335, 3362, 3389, 3416, 3443, 3468, 3494, 3519, 3544,
143// 3568, 3591, 3615, 3637, 3660, 3681, 3703, 3723, 3744, 3763, 3782, 3801,
144// 3819, 3837, 3854, 3870, 3886, 3902, 3917, 3931, 3944, 3958, 3970, 3982,
145// 3993, 4004, 4014, 4024, 4033, 4041, 4049, 4056, 4062, 4068, 4074, 4078,
146// 4082, 4086, 4089, 4091, 4092, 4093, 4094, 4093, 4092, 4091, 4089, 4086,
147// 4082, 4078, 4074, 4068, 4062, 4056, 4049, 4041, 4033, 4024, 4014, 4004,
148// 3993, 3982, 3970, 3958, 3944, 3931, 3917, 3902, 3886, 3870, 3854, 3837,
149// 3819, 3801, 3782, 3763, 3744, 3723, 3703, 3681, 3660, 3637, 3615, 3591,
150// 3568, 3544, 3519, 3494, 3468, 3443, 3416, 3389, 3362, 3335, 3307, 3278,
151// 3250, 3221, 3191, 3161, 3131, 3101, 3070, 3039, 3008, 2976, 2944, 2912,
152// 2879, 2846, 2813, 2780, 2747, 2713, 2679, 2645, 2611, 2576, 2542, 2507,
153// 2472, 2437, 2402, 2367, 2331, 2296, 2260, 2225, 2189, 2154, 2118, 2082,
154// 2047, 2012, 1976, 1940, 1905, 1869, 1834, 1798, 1763, 1727, 1692, 1657,
155// 1622, 1587, 1552, 1518, 1483, 1449, 1415, 1381, 1347, 1314, 1281, 1248,
156// 1215, 1182, 1150, 1118, 1086, 1055, 1024, 993, 963, 933, 903, 873,
157// 844, 816, 787, 759, 732, 705, 678, 651, 626, 600, 575, 550,
158// 526, 503, 479, 457, 434, 413, 391, 371, 350, 331, 312, 293,
159// 275, 257, 240, 224, 208, 192, 177, 163, 150, 136, 124, 112,
160// 101, 90, 80, 70, 61, 53, 45, 38, 32, 26, 20, 16,
161// 12, 8, 5, 3, 2, 1, 0, 1, 2, 3, 5, 8,
162// 12, 16, 20, 26, 32, 38, 45, 53, 61, 70, 80, 90,
163// 101, 112, 124, 136, 150, 163, 177, 192, 208, 224, 240, 257,
164// 275, 293, 312, 331, 350, 371, 391, 413, 434, 457, 479, 503,
165// 526, 550, 575, 600, 626, 651, 678, 705, 732, 759, 787, 816,
166// 844, 873, 903, 933, 963, 993, 1024, 1055, 1086, 1118, 1150, 1182,
167// 1215, 1248, 1281, 1314, 1347, 1381, 1415, 1449, 1483, 1518, 1552, 1587,
168// 1622, 1657, 1692, 1727, 1763, 1798, 1834, 1869, 1905, 1940, 1976, 2012
169// };
170
171// static const dacsample_t dac_buffer_2[DAC_BUFFER_SIZE] = {
172// 12, 8, 5, 3, 2, 1, 0, 1, 2, 3, 5, 8,
173// 12, 16, 20, 26, 32, 38, 45, 53, 61, 70, 80, 90,
174// 101, 112, 124, 136, 150, 163, 177, 192, 208, 224, 240, 257,
175// 275, 293, 312, 331, 350, 371, 391, 413, 434, 457, 479, 503,
176// 526, 550, 575, 600, 626, 651, 678, 705, 732, 759, 787, 816,
177// 844, 873, 903, 933, 963, 993, 1024, 1055, 1086, 1118, 1150, 1182,
178// 1215, 1248, 1281, 1314, 1347, 1381, 1415, 1449, 1483, 1518, 1552, 1587,
179// 1622, 1657, 1692, 1727, 1763, 1798, 1834, 1869, 1905, 1940, 1976, 2012,
180// 2047, 2082, 2118, 2154, 2189, 2225, 2260, 2296, 2331, 2367, 2402, 2437,
181// 2472, 2507, 2542, 2576, 2611, 2645, 2679, 2713, 2747, 2780, 2813, 2846,
182// 2879, 2912, 2944, 2976, 3008, 3039, 3070, 3101, 3131, 3161, 3191, 3221,
183// 3250, 3278, 3307, 3335, 3362, 3389, 3416, 3443, 3468, 3494, 3519, 3544,
184// 3568, 3591, 3615, 3637, 3660, 3681, 3703, 3723, 3744, 3763, 3782, 3801,
185// 3819, 3837, 3854, 3870, 3886, 3902, 3917, 3931, 3944, 3958, 3970, 3982,
186// 3993, 4004, 4014, 4024, 4033, 4041, 4049, 4056, 4062, 4068, 4074, 4078,
187// 4082, 4086, 4089, 4091, 4092, 4093, 4094, 4093, 4092, 4091, 4089, 4086,
188// 4082, 4078, 4074, 4068, 4062, 4056, 4049, 4041, 4033, 4024, 4014, 4004,
189// 3993, 3982, 3970, 3958, 3944, 3931, 3917, 3902, 3886, 3870, 3854, 3837,
190// 3819, 3801, 3782, 3763, 3744, 3723, 3703, 3681, 3660, 3637, 3615, 3591,
191// 3568, 3544, 3519, 3494, 3468, 3443, 3416, 3389, 3362, 3335, 3307, 3278,
192// 3250, 3221, 3191, 3161, 3131, 3101, 3070, 3039, 3008, 2976, 2944, 2912,
193// 2879, 2846, 2813, 2780, 2747, 2713, 2679, 2645, 2611, 2576, 2542, 2507,
194// 2472, 2437, 2402, 2367, 2331, 2296, 2260, 2225, 2189, 2154, 2118, 2082,
195// 2047, 2012, 1976, 1940, 1905, 1869, 1834, 1798, 1763, 1727, 1692, 1657,
196// 1622, 1587, 1552, 1518, 1483, 1449, 1415, 1381, 1347, 1314, 1281, 1248,
197// 1215, 1182, 1150, 1118, 1086, 1055, 1024, 993, 963, 933, 903, 873,
198// 844, 816, 787, 759, 732, 705, 678, 651, 626, 600, 575, 550,
199// 526, 503, 479, 457, 434, 413, 391, 371, 350, 331, 312, 293,
200// 275, 257, 240, 224, 208, 192, 177, 163, 150, 136, 124, 112,
201// 101, 90, 80, 70, 61, 53, 45, 38, 32, 26, 20, 16
202// };
203
204// squarewave
205static const dacsample_t dac_buffer[DAC_BUFFER_SIZE] = {
206 // First half is max, second half is 0
207 [0 ... DAC_BUFFER_SIZE / 2 - 1] = DAC_SAMPLE_MAX,
208 [DAC_BUFFER_SIZE / 2 ... DAC_BUFFER_SIZE - 1] = 0,
209};
210
211// squarewave
212static const dacsample_t dac_buffer_2[DAC_BUFFER_SIZE] = {
213 // opposite of dac_buffer above
214 [0 ... DAC_BUFFER_SIZE / 2 - 1] = 0,
215 [DAC_BUFFER_SIZE / 2 ... DAC_BUFFER_SIZE - 1] = DAC_SAMPLE_MAX,
216};
217
218/*
219 * DAC streaming callback.
220 */
221size_t nz = 0;
222static void end_cb1(DACDriver *dacp) {
223 (void)dacp;
224
225 nz++;
226 if ((nz % 1000) == 0) {
227 // palTogglePad(GPIOD, GPIOD_LED3);
228 }
229}
230
231/*
232 * DAC error callback.
233 */
234static void error_cb1(DACDriver *dacp, dacerror_t err) {
235 (void)dacp;
236 (void)err;
237
238 chSysHalt("DAC failure");
239}
240
241static const DACConfig dac1cfg1 = {.init = DAC_SAMPLE_MAX, .datamode = DAC_DHRM_12BIT_RIGHT};
242
243static const DACConversionGroup dacgrpcfg1 = {.num_channels = 1U, .end_cb = end_cb1, .error_cb = error_cb1, .trigger = DAC_TRG(0)};
244
245static const DACConfig dac1cfg2 = {.init = DAC_SAMPLE_MAX, .datamode = DAC_DHRM_12BIT_RIGHT};
246
247static const DACConversionGroup dacgrpcfg2 = {.num_channels = 1U, .end_cb = end_cb1, .error_cb = error_cb1, .trigger = DAC_TRG(0)};
248
249void audio_init() {
250 if (audio_initialized) {
251 return;
252 }
253
254// Check EEPROM
255#ifdef EEPROM_ENABLE
256 if (!eeconfig_is_enabled()) {
257 eeconfig_init();
258 }
259 audio_config.raw = eeconfig_read_audio();
260#else // ARM EEPROM
261 audio_config.enable = true;
262# ifdef AUDIO_CLICKY_ON
263 audio_config.clicky_enable = true;
264# endif
265#endif // ARM EEPROM
266
267 /*
268 * Starting DAC1 driver, setting up the output pin as analog as suggested
269 * by the Reference Manual.
270 */
271 palSetPadMode(GPIOA, 4, PAL_MODE_INPUT_ANALOG);
272 palSetPadMode(GPIOA, 5, PAL_MODE_INPUT_ANALOG);
273 dacStart(&DACD1, &dac1cfg1);
274 dacStart(&DACD2, &dac1cfg2);
275
276 /*
277 * Starting GPT6/7 driver, it is used for triggering the DAC.
278 */
279 START_CHANNEL_1();
280 START_CHANNEL_2();
281
282 /*
283 * Starting a continuous conversion.
284 */
285 dacStartConversion(&DACD1, &dacgrpcfg1, (dacsample_t *)dac_buffer, DAC_BUFFER_SIZE);
286 dacStartConversion(&DACD2, &dacgrpcfg2, (dacsample_t *)dac_buffer_2, DAC_BUFFER_SIZE);
287
288 audio_initialized = true;
289
290 if (audio_config.enable) {
291 PLAY_SONG(startup_song);
292 } else {
293 stop_all_notes();
294 }
295}
296
297void stop_all_notes() {
298 dprintf("audio stop all notes");
299
300 if (!audio_initialized) {
301 audio_init();
302 }
303 voices = 0;
304
305 gptStopTimer(&GPTD6);
306 gptStopTimer(&GPTD7);
307 gptStopTimer(&GPTD8);
308
309 playing_notes = false;
310 playing_note = false;
311 frequency = 0;
312 frequency_alt = 0;
313 volume = 0;
314
315 for (uint8_t i = 0; i < 8; i++) {
316 frequencies[i] = 0;
317 volumes[i] = 0;
318 }
319}
320
321void stop_note(float freq) {
322 dprintf("audio stop note freq=%d", (int)freq);
323
324 if (playing_note) {
325 if (!audio_initialized) {
326 audio_init();
327 }
328 for (int i = 7; i >= 0; i--) {
329 if (frequencies[i] == freq) {
330 frequencies[i] = 0;
331 volumes[i] = 0;
332 for (int j = i; (j < 7); j++) {
333 frequencies[j] = frequencies[j + 1];
334 frequencies[j + 1] = 0;
335 volumes[j] = volumes[j + 1];
336 volumes[j + 1] = 0;
337 }
338 break;
339 }
340 }
341 voices--;
342 if (voices < 0) {
343 voices = 0;
344 }
345 if (voice_place >= voices) {
346 voice_place = 0;
347 }
348 if (voices == 0) {
349 STOP_CHANNEL_1();
350 STOP_CHANNEL_2();
351 gptStopTimer(&GPTD8);
352 frequency = 0;
353 frequency_alt = 0;
354 volume = 0;
355 playing_note = false;
356 }
357 }
358}
359
360#ifdef VIBRATO_ENABLE
361
362float mod(float a, int b) {
363 float r = fmod(a, b);
364 return r < 0 ? r + b : r;
365}
366
367float vibrato(float average_freq) {
368# ifdef VIBRATO_STRENGTH_ENABLE
369 float vibrated_freq = average_freq * pow(vibrato_lut[(int)vibrato_counter], vibrato_strength);
370# else
371 float vibrated_freq = average_freq * vibrato_lut[(int)vibrato_counter];
372# endif
373 vibrato_counter = mod((vibrato_counter + vibrato_rate * (1.0 + 440.0 / average_freq)), VIBRATO_LUT_LENGTH);
374 return vibrated_freq;
375}
376
377#endif
378
379static void gpt_cb8(GPTDriver *gptp) {
380 float freq;
381
382 if (playing_note) {
383 if (voices > 0) {
384 float freq_alt = 0;
385 if (voices > 1) {
386 if (polyphony_rate == 0) {
387 if (glissando) {
388 if (frequency_alt != 0 && frequency_alt < frequencies[voices - 2] && frequency_alt < frequencies[voices - 2] * pow(2, -440 / frequencies[voices - 2] / 12 / 2)) {
389 frequency_alt = frequency_alt * pow(2, 440 / frequency_alt / 12 / 2);
390 } else if (frequency_alt != 0 && frequency_alt > frequencies[voices - 2] && frequency_alt > frequencies[voices - 2] * pow(2, 440 / frequencies[voices - 2] / 12 / 2)) {
391 frequency_alt = frequency_alt * pow(2, -440 / frequency_alt / 12 / 2);
392 } else {
393 frequency_alt = frequencies[voices - 2];
394 }
395 } else {
396 frequency_alt = frequencies[voices - 2];
397 }
398
399#ifdef VIBRATO_ENABLE
400 if (vibrato_strength > 0) {
401 freq_alt = vibrato(frequency_alt);
402 } else {
403 freq_alt = frequency_alt;
404 }
405#else
406 freq_alt = frequency_alt;
407#endif
408 }
409
410 if (envelope_index < 65535) {
411 envelope_index++;
412 }
413
414 freq_alt = voice_envelope(freq_alt);
415
416 if (freq_alt < 30.517578125) {
417 freq_alt = 30.52;
418 }
419
420 if (GET_CHANNEL_2_FREQ != (uint16_t)freq_alt) {
421 UPDATE_CHANNEL_2_FREQ(freq_alt);
422 } else {
423 RESTART_CHANNEL_2();
424 }
425 // note_timbre;
426 }
427
428 if (polyphony_rate > 0) {
429 if (voices > 1) {
430 voice_place %= voices;
431 if (place++ > (frequencies[voice_place] / polyphony_rate)) {
432 voice_place = (voice_place + 1) % voices;
433 place = 0.0;
434 }
435 }
436
437#ifdef VIBRATO_ENABLE
438 if (vibrato_strength > 0) {
439 freq = vibrato(frequencies[voice_place]);
440 } else {
441 freq = frequencies[voice_place];
442 }
443#else
444 freq = frequencies[voice_place];
445#endif
446 } else {
447 if (glissando) {
448 if (frequency != 0 && frequency < frequencies[voices - 1] && frequency < frequencies[voices - 1] * pow(2, -440 / frequencies[voices - 1] / 12 / 2)) {
449 frequency = frequency * pow(2, 440 / frequency / 12 / 2);
450 } else if (frequency != 0 && frequency > frequencies[voices - 1] && frequency > frequencies[voices - 1] * pow(2, 440 / frequencies[voices - 1] / 12 / 2)) {
451 frequency = frequency * pow(2, -440 / frequency / 12 / 2);
452 } else {
453 frequency = frequencies[voices - 1];
454 }
455 } else {
456 frequency = frequencies[voices - 1];
457 }
458
459#ifdef VIBRATO_ENABLE
460 if (vibrato_strength > 0) {
461 freq = vibrato(frequency);
462 } else {
463 freq = frequency;
464 }
465#else
466 freq = frequency;
467#endif
468 }
469
470 if (envelope_index < 65535) {
471 envelope_index++;
472 }
473
474 freq = voice_envelope(freq);
475
476 if (freq < 30.517578125) {
477 freq = 30.52;
478 }
479
480 if (GET_CHANNEL_1_FREQ != (uint16_t)freq) {
481 UPDATE_CHANNEL_1_FREQ(freq);
482 } else {
483 RESTART_CHANNEL_1();
484 }
485 // note_timbre;
486 }
487 }
488
489 if (playing_notes) {
490 if (note_frequency > 0) {
491#ifdef VIBRATO_ENABLE
492 if (vibrato_strength > 0) {
493 freq = vibrato(note_frequency);
494 } else {
495 freq = note_frequency;
496 }
497#else
498 freq = note_frequency;
499#endif
500
501 if (envelope_index < 65535) {
502 envelope_index++;
503 }
504 freq = voice_envelope(freq);
505
506 if (GET_CHANNEL_1_FREQ != (uint16_t)freq) {
507 UPDATE_CHANNEL_1_FREQ(freq);
508 UPDATE_CHANNEL_2_FREQ(freq);
509 }
510 // note_timbre;
511 } else {
512 // gptStopTimer(&GPTD6);
513 // gptStopTimer(&GPTD7);
514 }
515
516 note_position++;
517 bool end_of_note = false;
518 if (GET_CHANNEL_1_FREQ > 0) {
519 if (!note_resting)
520 end_of_note = (note_position >= (note_length * 8 - 1));
521 else
522 end_of_note = (note_position >= (note_length * 8));
523 } else {
524 end_of_note = (note_position >= (note_length * 8));
525 }
526
527 if (end_of_note) {
528 current_note++;
529 if (current_note >= notes_count) {
530 if (notes_repeat) {
531 current_note = 0;
532 } else {
533 STOP_CHANNEL_1();
534 STOP_CHANNEL_2();
535 // gptStopTimer(&GPTD8);
536 playing_notes = false;
537 return;
538 }
539 }
540 if (!note_resting) {
541 note_resting = true;
542 current_note--;
543 if ((*notes_pointer)[current_note][0] == (*notes_pointer)[current_note + 1][0]) {
544 note_frequency = 0;
545 note_length = 1;
546 } else {
547 note_frequency = (*notes_pointer)[current_note][0];
548 note_length = 1;
549 }
550 } else {
551 note_resting = false;
552 envelope_index = 0;
553 note_frequency = (*notes_pointer)[current_note][0];
554 note_length = ((*notes_pointer)[current_note][1] / 4) * (((float)note_tempo) / 100);
555 }
556
557 note_position = 0;
558 }
559 }
560
561 if (!audio_config.enable) {
562 playing_notes = false;
563 playing_note = false;
564 }
565}
566
567void play_note(float freq, int vol) {
568 dprintf("audio play note freq=%d vol=%d", (int)freq, vol);
569
570 if (!audio_initialized) {
571 audio_init();
572 }
573
574 if (audio_config.enable && voices < 8) {
575 // Cancel notes if notes are playing
576 if (playing_notes) {
577 stop_all_notes();
578 }
579
580 playing_note = true;
581
582 envelope_index = 0;
583
584 if (freq > 0) {
585 frequencies[voices] = freq;
586 volumes[voices] = vol;
587 voices++;
588 }
589
590 gptStart(&GPTD8, &gpt8cfg1);
591 gptStartContinuous(&GPTD8, 2U);
592 RESTART_CHANNEL_1();
593 RESTART_CHANNEL_2();
594 }
595}
596
597void play_notes(float (*np)[][2], uint16_t n_count, bool n_repeat) {
598 if (!audio_initialized) {
599 audio_init();
600 }
601
602 if (audio_config.enable) {
603 // Cancel note if a note is playing
604 if (playing_note) {
605 stop_all_notes();
606 }
607
608 playing_notes = true;
609
610 notes_pointer = np;
611 notes_count = n_count;
612 notes_repeat = n_repeat;
613
614 place = 0;
615 current_note = 0;
616
617 note_frequency = (*notes_pointer)[current_note][0];
618 note_length = ((*notes_pointer)[current_note][1] / 4) * (((float)note_tempo) / 100);
619 note_position = 0;
620
621 gptStart(&GPTD8, &gpt8cfg1);
622 gptStartContinuous(&GPTD8, 2U);
623 RESTART_CHANNEL_1();
624 RESTART_CHANNEL_2();
625 }
626}
627
628bool is_playing_notes(void) { return playing_notes; }
629
630bool is_audio_on(void) { return (audio_config.enable != 0); }
631
632void audio_toggle(void) {
633 audio_config.enable ^= 1;
634 eeconfig_update_audio(audio_config.raw);
635 if (audio_config.enable) {
636 audio_on_user();
637 }
638}
639
640void audio_on(void) {
641 audio_config.enable = 1;
642 eeconfig_update_audio(audio_config.raw);
643 audio_on_user();
644}
645
646void audio_off(void) {
647 stop_all_notes();
648 audio_config.enable = 0;
649 eeconfig_update_audio(audio_config.raw);
650}
651
652#ifdef VIBRATO_ENABLE
653
654// Vibrato rate functions
655
656void set_vibrato_rate(float rate) { vibrato_rate = rate; }
657
658void increase_vibrato_rate(float change) { vibrato_rate *= change; }
659
660void decrease_vibrato_rate(float change) { vibrato_rate /= change; }
661
662# ifdef VIBRATO_STRENGTH_ENABLE
663
664void set_vibrato_strength(float strength) { vibrato_strength = strength; }
665
666void increase_vibrato_strength(float change) { vibrato_strength *= change; }
667
668void decrease_vibrato_strength(float change) { vibrato_strength /= change; }
669
670# endif /* VIBRATO_STRENGTH_ENABLE */
671
672#endif /* VIBRATO_ENABLE */
673
674// Polyphony functions
675
676void set_polyphony_rate(float rate) { polyphony_rate = rate; }
677
678void enable_polyphony() { polyphony_rate = 5; }
679
680void disable_polyphony() { polyphony_rate = 0; }
681
682void increase_polyphony_rate(float change) { polyphony_rate *= change; }
683
684void decrease_polyphony_rate(float change) { polyphony_rate /= change; }
685
686// Timbre function
687
688void set_timbre(float timbre) { note_timbre = timbre; }
689
690// Tempo functions
691
692void set_tempo(uint8_t tempo) { note_tempo = tempo; }
693
694void decrease_tempo(uint8_t tempo_change) { note_tempo += tempo_change; }
695
696void increase_tempo(uint8_t tempo_change) {
697 if (note_tempo - tempo_change < 10) {
698 note_tempo = 10;
699 } else {
700 note_tempo -= tempo_change;
701 }
702}
generated by cgit v1.2.3 (git 2.25.1) at 2025-07-02 06:02:43 +0000