João Brázio
9 years ago
committed by
Scott Lahteine
parent
26f8f54c56
commit
5b5aa1572b
@ -1,57 +0,0 @@
|
|||||||
/**
|
|
||||||
* Marlin 3D Printer Firmware
|
|
||||||
* Copyright (C) 2016 MarlinFirmware [https://github.com/MarlinFirmware/Marlin]
|
|
||||||
*
|
|
||||||
* Based on Sprinter and grbl.
|
|
||||||
* Copyright (C) 2011 Camiel Gubbels / Erik van der Zalm
|
|
||||||
*
|
|
||||||
* This program is free software: you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License as published by
|
|
||||||
* the Free Software Foundation, either version 3 of the License, or
|
|
||||||
* (at your option) any later version.
|
|
||||||
*
|
|
||||||
* This program is distributed in the hope that it will be useful,
|
|
||||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
||||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
||||||
* GNU General Public License for more details.
|
|
||||||
*
|
|
||||||
* You should have received a copy of the GNU General Public License
|
|
||||||
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|
||||||
*
|
|
||||||
*/
|
|
||||||
|
|
||||||
#include "Marlin.h"
|
|
||||||
#if HAS_BUZZER
|
|
||||||
#include "buzzer.h"
|
|
||||||
#include "ultralcd.h"
|
|
||||||
|
|
||||||
void buzz(long duration, uint16_t freq) {
|
|
||||||
if (freq > 0) {
|
|
||||||
#if ENABLED(LCD_USE_I2C_BUZZER)
|
|
||||||
lcd_buzz(duration, freq);
|
|
||||||
#elif PIN_EXISTS(BEEPER) // on-board buzzers have no further condition
|
|
||||||
SET_OUTPUT(BEEPER_PIN);
|
|
||||||
#if ENABLED(SPEAKER) // a speaker needs a AC ore a pulsed DC
|
|
||||||
//tone(BEEPER_PIN, freq, duration); // needs a PWMable pin
|
|
||||||
unsigned int delay = 1000000 / freq / 2;
|
|
||||||
int i = duration * freq / 1000;
|
|
||||||
while (i--) {
|
|
||||||
WRITE(BEEPER_PIN, HIGH);
|
|
||||||
delayMicroseconds(delay);
|
|
||||||
WRITE(BEEPER_PIN, LOW);
|
|
||||||
delayMicroseconds(delay);
|
|
||||||
}
|
|
||||||
#else // buzzer has its own resonator - needs a DC
|
|
||||||
WRITE(BEEPER_PIN, HIGH);
|
|
||||||
delay(duration);
|
|
||||||
WRITE(BEEPER_PIN, LOW);
|
|
||||||
#endif
|
|
||||||
#else
|
|
||||||
delay(duration);
|
|
||||||
#endif
|
|
||||||
}
|
|
||||||
else {
|
|
||||||
delay(duration);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
@ -0,0 +1,146 @@
|
|||||||
|
/**
|
||||||
|
* Marlin 3D Printer Firmware
|
||||||
|
* Copyright (C) 2016 MarlinFirmware [https://github.com/MarlinFirmware/Marlin]
|
||||||
|
*
|
||||||
|
* Based on Sprinter and grbl.
|
||||||
|
* Copyright (C) 2011 Camiel Gubbels / Erik van der Zalm
|
||||||
|
*
|
||||||
|
* This program is free software: you can redistribute it and/or modify
|
||||||
|
* it under the terms of the GNU General Public License as published by
|
||||||
|
* the Free Software Foundation, either version 3 of the License, or
|
||||||
|
* (at your option) any later version.
|
||||||
|
*
|
||||||
|
* This program is distributed in the hope that it will be useful,
|
||||||
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||||
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||||
|
* GNU General Public License for more details.
|
||||||
|
*
|
||||||
|
* You should have received a copy of the GNU General Public License
|
||||||
|
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef __CIRCULARQUEUE_H__
|
||||||
|
#define __CIRCULARQUEUE_H__
|
||||||
|
|
||||||
|
#include <Arduino.h>
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Circular Queue class
|
||||||
|
* @details Implementation of the classic ring buffer data structure
|
||||||
|
*/
|
||||||
|
template<typename T, int N>
|
||||||
|
class CircularQueue {
|
||||||
|
private:
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Buffer structure
|
||||||
|
* @details This structure consolidates all the overhead required to handle
|
||||||
|
* a circular queue such as the pointers and the buffer vector.
|
||||||
|
*/
|
||||||
|
struct buffer_t {
|
||||||
|
uint8_t head;
|
||||||
|
uint8_t tail;
|
||||||
|
uint8_t size;
|
||||||
|
uint8_t length;
|
||||||
|
T queue[N];
|
||||||
|
} buffer;
|
||||||
|
|
||||||
|
public:
|
||||||
|
/**
|
||||||
|
* @brief Class constructor
|
||||||
|
* @details This class requires two template parameters, T defines the type
|
||||||
|
* of the items this queue will handle and N defines the maximum number of
|
||||||
|
* items that can be stored on the queue.
|
||||||
|
*/
|
||||||
|
CircularQueue<T, N>() {
|
||||||
|
this->buffer.length = N;
|
||||||
|
this->buffer.size = this->buffer.head = this->buffer.tail = 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Removes and returns a item from the queue
|
||||||
|
* @details Removes the oldest item on the queue which is pointed by the
|
||||||
|
* buffer_t head variable, this item is then returned to the caller.
|
||||||
|
* @return type T item
|
||||||
|
*/
|
||||||
|
T dequeue() {
|
||||||
|
if (this->isEmpty()) return T();
|
||||||
|
|
||||||
|
T const item = this->buffer.queue[this->buffer.head++];
|
||||||
|
--this->buffer.size;
|
||||||
|
|
||||||
|
if (this->buffer.head == this->buffer.length)
|
||||||
|
this->buffer.head = 0;
|
||||||
|
|
||||||
|
return item;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Adds an item to the queue
|
||||||
|
* @details Adds a item to the queue on the location pointed by the buffer_t
|
||||||
|
* tail vairable, will return false if there is no queue space available.
|
||||||
|
*
|
||||||
|
* @param item Item to be added to the queue
|
||||||
|
* @return true if the operation was successfull
|
||||||
|
*/
|
||||||
|
bool enqueue(T const &item) {
|
||||||
|
if (this->isFull()) return false;
|
||||||
|
|
||||||
|
this->buffer.queue[this->buffer.tail++] = item;
|
||||||
|
++this->buffer.size;
|
||||||
|
|
||||||
|
if (this->buffer.tail == this->buffer.length)
|
||||||
|
this->buffer.tail = 0;
|
||||||
|
|
||||||
|
return true;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Checks if the queue has no items
|
||||||
|
* @details Returns true if there are no items on the queue, false otherwise.
|
||||||
|
* @return true if queue is empty
|
||||||
|
*/
|
||||||
|
bool isEmpty() {
|
||||||
|
return this->buffer.size == 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Checks if the queue is full
|
||||||
|
* @details Returns true if the queue is full, false otherwise.
|
||||||
|
* @return true if queue is full
|
||||||
|
*/
|
||||||
|
bool isFull() {
|
||||||
|
return this->buffer.size == this->buffer.length;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Gets the queue size
|
||||||
|
* @details Returns the maximum number of items a queue can have.
|
||||||
|
* @return the queue lenght
|
||||||
|
*/
|
||||||
|
uint8_t length() {
|
||||||
|
return this->buffer.length;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Gets the next item from the queue without removing it
|
||||||
|
* @details Returns the next item on the queue but the item is not removed
|
||||||
|
* from the queue nor the pointers updated.
|
||||||
|
* @return the queue size
|
||||||
|
*/
|
||||||
|
uint8_t peek() {
|
||||||
|
return this->buffer.queue[this->buffer.head];
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Gets the number of items on the queue
|
||||||
|
* @details Returns the current number of items stored on the queue.
|
||||||
|
* @return type T item
|
||||||
|
*/
|
||||||
|
uint8_t size() {
|
||||||
|
return this->buffer.size;
|
||||||
|
}
|
||||||
|
};
|
||||||
|
|
||||||
|
#endif
|
||||||
@ -0,0 +1,92 @@
|
|||||||
|
/**
|
||||||
|
* Marlin 3D Printer Firmware
|
||||||
|
* Copyright (C) 2016 MarlinFirmware [https://github.com/MarlinFirmware/Marlin]
|
||||||
|
*
|
||||||
|
* Based on Sprinter and grbl.
|
||||||
|
* Copyright (C) 2011 Camiel Gubbels / Erik van der Zalm
|
||||||
|
*
|
||||||
|
* This program is free software: you can redistribute it and/or modify
|
||||||
|
* it under the terms of the GNU General Public License as published by
|
||||||
|
* the Free Software Foundation, either version 3 of the License, or
|
||||||
|
* (at your option) any later version.
|
||||||
|
*
|
||||||
|
* This program is distributed in the hope that it will be useful,
|
||||||
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||||
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||||
|
* GNU General Public License for more details.
|
||||||
|
*
|
||||||
|
* You should have received a copy of the GNU General Public License
|
||||||
|
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef __SPEAKER_H__
|
||||||
|
#define __SPEAKER_H__
|
||||||
|
|
||||||
|
#include "buzzer.h"
|
||||||
|
|
||||||
|
class Speaker: public Buzzer {
|
||||||
|
private:
|
||||||
|
typedef Buzzer super;
|
||||||
|
|
||||||
|
struct state_t {
|
||||||
|
tone_t tone;
|
||||||
|
uint16_t period;
|
||||||
|
uint16_t cycles;
|
||||||
|
} state;
|
||||||
|
|
||||||
|
protected:
|
||||||
|
/**
|
||||||
|
* @brief Resets the state of the class
|
||||||
|
* @details Brings the class state to a known one.
|
||||||
|
*/
|
||||||
|
void reset() {
|
||||||
|
super::reset();
|
||||||
|
this->state.period = 0;
|
||||||
|
this->state.cycles = 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
public:
|
||||||
|
/**
|
||||||
|
* @brief Class constructor
|
||||||
|
*/
|
||||||
|
Speaker() {
|
||||||
|
this->reset();
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Loop function
|
||||||
|
* @details This function should be called at loop, it will take care of
|
||||||
|
* playing the tones in the queue.
|
||||||
|
*/
|
||||||
|
virtual void tick() {
|
||||||
|
if (!this->state.cycles) {
|
||||||
|
if (this->buffer.isEmpty()) return;
|
||||||
|
|
||||||
|
this->reset();
|
||||||
|
this->state.tone = this->buffer.dequeue();
|
||||||
|
|
||||||
|
// Period is uint16, min frequency will be ~16Hz
|
||||||
|
this->state.period = 1000000UL / this->state.tone.frequency;
|
||||||
|
|
||||||
|
this->state.cycles =
|
||||||
|
(this->state.tone.duration * 1000L) / this->state.period;
|
||||||
|
|
||||||
|
this->state.period >>= 1;
|
||||||
|
this->state.cycles <<= 1;
|
||||||
|
|
||||||
|
}
|
||||||
|
else {
|
||||||
|
uint32_t const us = micros();
|
||||||
|
static uint32_t next = us + this->state.period;
|
||||||
|
|
||||||
|
if (us >= next) {
|
||||||
|
--this->state.cycles;
|
||||||
|
next = us + this->state.period;
|
||||||
|
if (this->state.tone.frequency > 0) this->invert();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
};
|
||||||
|
|
||||||
|
#endif
|
||||||
Loading…
Reference in new issue