summaryrefslogtreecommitdiff
path: root/quantum/beeps.c
blob: 08b35abbd84474989f5c82054c9f4a063faaff03 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
#include <stdio.h>
#include <string.h>
#include <math.h>
#include <avr/pgmspace.h>
#include <avr/interrupt.h>
#include <avr/io.h>

#include "beeps.h"
#include "keymap_common.h"
#include "wave.h"

#define PI 3.14159265

#define SAMPLE_DIVIDER 70
#define SAMPLE_RATE (2000000.0/SAMPLE_DIVIDER/256)
// Resistor value of 1/ (2 * PI * 10nF * (2000000 hertz / SAMPLE_DIVIDER / 10)) for 10nF cap

void delay_us(int count) {
  while(count--) {
    _delay_us(1);
  }
}

int voices = 0;
double frequency = 0;
int volume = 0;
long position = 0;

double frequencies[8] = {0, 0, 0, 0, 0, 0, 0, 0};
int volumes[8] = {0, 0, 0, 0, 0, 0, 0, 0};
bool sliding = false;
#define RANGE 1000
volatile int i=0; //elements of the wave

void stop_all_notes() {
    voices = 0;
    TIMSK3 &= ~_BV(OCIE3A);
    frequency = 0;
    volume = 0;

    for (int i = 0; i < 8; i++) {
        frequencies[i] = 0;
        volumes[i] = 0;
    }
}

void stop_note(double freq) {
    freq = freq / SAMPLE_RATE;
    for (int i = 7; i >= 0; i--) {
        if (frequencies[i] == freq) {
            frequencies[i] = 0;
            volumes[i] = 0;
            for (int j = i; (j < 7); j++) {
                frequencies[j] = frequencies[j+1];
                frequencies[j+1] = 0;
                volumes[j] = volumes[j+1];
                volumes[j+1] = 0;
            }
        }
    }
    voices--;
    if (voices < 0)
        voices = 0;
    if (voices == 0) {
        TIMSK3 &= ~_BV(OCIE3A);
        frequency = 0;
        volume = 0;
    } else {
        double freq = frequencies[voices - 1];
        int vol = volumes[voices - 1];
        double starting_f = frequency;
        if (frequency < freq) {
            sliding = true;
            for (double f = starting_f; f <= freq; f += ((freq - starting_f) / 500.0)) {
                frequency = f;
            }
            sliding = false;
        } else if (frequency > freq) {
            sliding = true;
            for (double f = starting_f; f >= freq; f -= ((starting_f - freq) / 500.0)) {
                frequency = f;
            }
            sliding = false;
        }
        frequency = freq;
        volume = vol;
    }
}

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;

  /* Enable the OC4A output */
  DDRC |= _BV(PORTC6);

}

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]);
    
    // SQUARE
    // if (((int)place) >= 1024){
    //     OCR4A = 0xFF;
    // } else {
    //     OCR4A = 0x00;
    // }
    
    // SAWTOOTH
    // OCR4A = (int)place / 4;

    // TRIANGLE
    // if (((int)place) >= 1024) {
    //     OCR4A = (int)place / 2;
    // } else {
    //     OCR4A = 2048 - (int)place / 2;
    // }

    place += frequency;
    if (place >= SINE_LENGTH)
        place -= SINE_LENGTH;

}

void play_note(double freq, int vol) {

    freq = freq / SAMPLE_RATE;
    if (freq > 0) {
        if (frequency != 0) {
            double starting_f = frequency;
            if (frequency < freq) {
                for (double f = starting_f; f <= freq; f += ((freq - starting_f) / 500.0)) {   
                    frequency = f;
                }
            } else if (frequency > freq) {
                for (double f = starting_f; f >= freq; f -= ((starting_f - freq) / 500.0)) {
                    frequency = f;
                }
            }
        }
        frequency = freq;
        volume = vol;

        frequencies[voices] = frequency;
        volumes[voices] = volume;
        voices++;
    }

    TIMSK3 &= ~_BV(OCIE3A);

    TCCR3A = 0x0; 
    TCCR3B = _BV(CS31) | _BV(WGM32);
    OCR3A = SAMPLE_DIVIDER - 1;

    TIMSK3 |= _BV(OCIE3A);

}