summaryrefslogtreecommitdiff
path: root/quantum/beeps.c
diff options
context:
space:
mode:
Diffstat (limited to 'quantum/beeps.c')
-rw-r--r--quantum/beeps.c147
1 files changed, 120 insertions, 27 deletions
diff --git a/quantum/beeps.c b/quantum/beeps.c
index 08b35abbd8..7586ebc522 100644
--- a/quantum/beeps.c
+++ b/quantum/beeps.c
@@ -11,8 +11,8 @@
#define PI 3.14159265
-#define SAMPLE_DIVIDER 70
-#define SAMPLE_RATE (2000000.0/SAMPLE_DIVIDER/256)
+#define SAMPLE_DIVIDER 39
+#define SAMPLE_RATE (2000000.0/SAMPLE_DIVIDER/2048)
// Resistor value of 1/ (2 * PI * 10nF * (2000000 hertz / SAMPLE_DIVIDER / 10)) for 10nF cap
void delay_us(int count) {
@@ -32,9 +32,31 @@ bool sliding = false;
#define RANGE 1000
volatile int i=0; //elements of the wave
+int max = 0xFF;
+float sum = 0;
+int value = 128;
+float place = 0;
+
+uint16_t place_int = 0;
+bool repeat = true;
+uint8_t * sample;
+uint16_t sample_length = 0;
+
+
+bool notes = false;
+float note_frequency = 0;
+float note_length = 0;
+uint16_t note_position = 0;
+float (* notes_pointer)[][2];
+uint8_t notes_length;
+bool notes_repeat;
+uint8_t current_note = 0;
+
void stop_all_notes() {
voices = 0;
TIMSK3 &= ~_BV(OCIE3A);
+ notes = false;
+ playing_notes = false;
frequency = 0;
volume = 0;
@@ -89,30 +111,35 @@ void stop_note(double freq) {
void init_notes() {
- PLLFRQ = _BV(PDIV2);
- PLLCSR = _BV(PLLE);
- while(!(PLLCSR & _BV(PLOCK)));
- PLLFRQ |= _BV(PLLTM0); /* PCK 48MHz */
-
- /* Init a fast PWM on Timer4 */
- TCCR4A = _BV(COM4A0) | _BV(PWM4A); /* Clear OC4A on Compare Match */
- TCCR4B = _BV(CS40); /* No prescaling => f = PCK/256 = 187500Hz */
- OCR4A = 0;
+ PLLFRQ = _BV(PDIV2);
+ PLLCSR = _BV(PLLE);
+ while(!(PLLCSR & _BV(PLOCK)));
+ PLLFRQ |= _BV(PLLTM0); /* PCK 48MHz */
+
+ /* Init a fast PWM on Timer4 */
+ TCCR4A = _BV(COM4A0) | _BV(PWM4A); /* Clear OC4A on Compare Match */
+ TCCR4B = _BV(CS40); /* No prescaling => f = PCK/256 = 187500Hz */
+ OCR4A = 0;
+
+ /* Enable the OC4A output */
+ DDRC |= _BV(PORTC6);
+
+ TIMSK3 &= ~_BV(OCIE3A); // Turn off 3A interputs
+
+ TCCR3A = 0x0; // Options not needed
+ TCCR3B = _BV(CS31) | _BV(CS30) | _BV(WGM32); // 64th prescaling and CTC
+ OCR3A = SAMPLE_DIVIDER - 1; // Correct count/compare, related to sample playback
- /* Enable the OC4A output */
- DDRC |= _BV(PORTC6);
+ playing_notes = false;
}
-int max = 0xFF;
-float sum = 0;
-int value = 128;
-float place = 0;
ISR(TIMER3_COMPA_vect) {
+
// SINE
- OCR4A = pgm_read_byte(&sinewave[(uint16_t)place]);
+ // OCR4A = pgm_read_byte(&sinewave[(uint16_t)place]);
// SQUARE
// if (((int)place) >= 1024){
@@ -131,12 +158,84 @@ ISR(TIMER3_COMPA_vect) {
// OCR4A = 2048 - (int)place / 2;
// }
- place += frequency;
- if (place >= SINE_LENGTH)
- place -= SINE_LENGTH;
+ // place += frequency;
+
+ // if (place >= SINE_LENGTH)
+ // if (repeat)
+ // place -= SINE_LENGTH;
+ // else
+ // TIMSK3 &= ~_BV(OCIE3A);
+
+ // SAMPLE
+ // OCR4A = pgm_read_byte(&sample[(uint16_t)place_int]);
+
+ // place_int++;
+
+ // if (place_int >= sample_length)
+ // if (repeat)
+ // place_int -= sample_length;
+ // else
+ // TIMSK3 &= ~_BV(OCIE3A);
+
+
+ if (notes) {
+ OCR4A = pgm_read_byte(&sinewave[(uint16_t)place]) >> 0;
+
+ place += note_frequency;
+ if (place >= SINE_LENGTH)
+ place -= SINE_LENGTH;
+ note_position++;
+ if (note_position >= note_length) {
+ current_note++;
+ if (current_note >= notes_length) {
+ if (notes_repeat) {
+ current_note = 0;
+ } else {
+ TIMSK3 &= ~_BV(OCIE3A);
+ notes = false;
+ playing_notes = false;
+ return;
+ }
+ }
+ note_frequency = (*notes_pointer)[current_note][0] / SAMPLE_RATE;
+ note_length = (*notes_pointer)[current_note][1];
+ note_position = 0;
+ }
+
+ }
}
+void play_notes(float (*np)[][2], uint8_t n_length, bool n_repeat) {
+ notes = true;
+
+ notes_pointer = np;
+ notes_length = n_length;
+ notes_repeat = n_repeat;
+
+ place = 0;
+ current_note = 0;
+ note_frequency = (*notes_pointer)[current_note][0] / SAMPLE_RATE;
+ note_length = (*notes_pointer)[current_note][1];
+ // note_frequency = 880.0 / SAMPLE_RATE;
+ // note_length = 1000;
+ note_position = 0;
+
+
+ TIMSK3 |= _BV(OCIE3A);
+ playing_notes = true;
+}
+
+void play_sample(uint8_t * s, uint16_t l, bool r) {
+ place_int = 0;
+ sample = s;
+ sample_length = l;
+ repeat = r;
+
+ TIMSK3 |= _BV(OCIE3A);
+ playing_notes = true;
+}
+
void play_note(double freq, int vol) {
freq = freq / SAMPLE_RATE;
@@ -161,12 +260,6 @@ void play_note(double freq, int vol) {
voices++;
}
- TIMSK3 &= ~_BV(OCIE3A);
-
- TCCR3A = 0x0;
- TCCR3B = _BV(CS31) | _BV(WGM32);
- OCR3A = SAMPLE_DIVIDER - 1;
-
TIMSK3 |= _BV(OCIE3A);
} \ No newline at end of file