vail-adapter/polybuzzer.cpp

45 lines
1006 B
C++

#include <Arduino.h>
#include "polybuzzer.h"
#include "equal_temperament.h"
PolyBuzzer::PolyBuzzer(uint8_t pin) {
for (int i = 0; i < POLYBUZZER_MAX_TONES; i++) {
this->tones[i] = 0;
}
this->playing = 0;
this->pin = pin;
pinMode(pin, OUTPUT);
}
void PolyBuzzer::update() {
for (int i = 0; i < POLYBUZZER_MAX_TONES; i++) {
if (this->tones[i]) {
if (this->playing != this->tones[i]) {
this->playing = this->tones[i];
tone(this->pin, this->tones[i]);
}
return;
}
}
this->playing = 0;
noTone(this->pin);
}
void PolyBuzzer::Tone(int slot, unsigned int frequency) {
this->tones[slot] = frequency;
this->update();
}
void PolyBuzzer::Note(int slot, uint8_t note) {
if (note > 127) {
note = 127;
}
this->Tone(slot, equalTemperamentNote[note]);
}
void PolyBuzzer::NoTone(int slot) {
tones[slot] = 0;
this->update();
}