MPCNC/Firmware
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity

Non-blocking speaker now uses arduino's tone()

Browse Source
This commit is contained in:
João Brázio 2016-07-28 23:54:46 +01:00
parent 3367e79fec
commit 8093c5f534
1 changed files with 7 additions and 23 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

30
Marlin/speaker.h
View File

@ -31,8 +31,7 @@ class Speaker: public Buzzer {
struct state_t { struct state_t {
tone_t tone; tone_t tone;
uint16_t period; millis_t next;
uint16_t counter;
} state; } state;
protected: protected:
@ -42,8 +41,7 @@ class Speaker: public Buzzer {
*/ */
void reset() { void reset() {
super::reset(); super::reset();
this->state.period = 0; this->state.next = 0;
this->state.counter = 0;
} }
public: public:
@ -60,29 +58,15 @@ class Speaker: public Buzzer {
* playing the tones in the queue. * playing the tones in the queue.
*/ */
virtual void tick() { virtual void tick() {
if (!this->state.counter) { const uint32_t now = millis();
if (now >= this->state.next) {
if (this->buffer.isEmpty()) return; if (this->buffer.isEmpty()) return;
this->reset(); this->reset();
this->state.tone = this->buffer.dequeue(); this->state.tone = this->buffer.dequeue();
this->state.next = now + this->state.tone.duration;
// Period is uint16, min frequency will be ~16Hz ::tone(BEEPER_PIN, this->state.tone.frequency, this->state.tone.duration);
this->state.period = 1000000UL / this->state.tone.frequency;
this->state.counter =
(this->state.tone.duration * 1000L) / this->state.period;
this->state.period >>= 1;
this->state.counter <<= 1;
} else {
const uint32_t now = micros();
static uint32_t next = now + this->state.period;
if (now >= next) {
--this->state.counter;
next = now + this->state.period;
if (this->state.tone.frequency > 0) this->invert();
}
} }
} }
}; };