2018-01-28 14:31:21 -04:00
|
|
|
#pragma once
|
|
|
|
|
|
|
|
#include "AP_HAL_ChibiOS.h"
|
2018-03-01 20:46:30 -04:00
|
|
|
|
2018-01-28 14:31:21 -04:00
|
|
|
#include "ch.h"
|
|
|
|
#include "hal.h"
|
|
|
|
|
|
|
|
#define OCTAVE_OFFSET 0
|
|
|
|
|
|
|
|
#define NOTE_B0 31
|
|
|
|
#define NOTE_C1 33
|
|
|
|
#define NOTE_CS1 35
|
|
|
|
#define NOTE_D1 37
|
|
|
|
#define NOTE_DS1 39
|
|
|
|
#define NOTE_E1 41
|
|
|
|
#define NOTE_F1 44
|
|
|
|
#define NOTE_FS1 46
|
|
|
|
#define NOTE_G1 49
|
|
|
|
#define NOTE_GS1 52
|
|
|
|
#define NOTE_A1 55
|
|
|
|
#define NOTE_AS1 58
|
|
|
|
#define NOTE_B1 62
|
|
|
|
#define NOTE_C2 65
|
|
|
|
#define NOTE_CS2 69
|
|
|
|
#define NOTE_D2 73
|
|
|
|
#define NOTE_DS2 78
|
|
|
|
#define NOTE_E2 82
|
|
|
|
#define NOTE_F2 87
|
|
|
|
#define NOTE_FS2 93
|
|
|
|
#define NOTE_G2 98
|
|
|
|
#define NOTE_GS2 104
|
|
|
|
#define NOTE_A2 110
|
|
|
|
#define NOTE_AS2 117
|
|
|
|
#define NOTE_B2 123
|
|
|
|
#define NOTE_C3 131
|
|
|
|
#define NOTE_CS3 139
|
|
|
|
#define NOTE_D3 147
|
|
|
|
#define NOTE_DS3 156
|
|
|
|
#define NOTE_E3 165
|
|
|
|
#define NOTE_F3 175
|
|
|
|
#define NOTE_FS3 185
|
|
|
|
#define NOTE_G3 196
|
|
|
|
#define NOTE_GS3 208
|
|
|
|
#define NOTE_A3 220
|
|
|
|
#define NOTE_AS3 233
|
|
|
|
#define NOTE_B3 247
|
|
|
|
#define NOTE_C4 262
|
|
|
|
#define NOTE_CS4 277
|
|
|
|
#define NOTE_D4 294
|
|
|
|
#define NOTE_DS4 311
|
|
|
|
#define NOTE_E4 330
|
|
|
|
#define NOTE_F4 349
|
|
|
|
#define NOTE_FS4 370
|
|
|
|
#define NOTE_G4 392
|
|
|
|
#define NOTE_GS4 415
|
|
|
|
#define NOTE_A4 440
|
|
|
|
#define NOTE_AS4 466
|
|
|
|
#define NOTE_B4 494
|
|
|
|
#define NOTE_C5 523
|
|
|
|
#define NOTE_CS5 554
|
|
|
|
#define NOTE_D5 587
|
|
|
|
#define NOTE_DS5 622
|
|
|
|
#define NOTE_E5 659
|
|
|
|
#define NOTE_F5 698
|
|
|
|
#define NOTE_FS5 740
|
|
|
|
#define NOTE_G5 784
|
|
|
|
#define NOTE_GS5 831
|
|
|
|
#define NOTE_A5 880
|
|
|
|
#define NOTE_AS5 932
|
|
|
|
#define NOTE_B5 988
|
|
|
|
#define NOTE_C6 1047
|
|
|
|
#define NOTE_CS6 1109
|
|
|
|
#define NOTE_D6 1175
|
|
|
|
#define NOTE_DS6 1245
|
|
|
|
#define NOTE_E6 1319
|
|
|
|
#define NOTE_F6 1397
|
|
|
|
#define NOTE_FS6 1480
|
|
|
|
#define NOTE_G6 1568
|
|
|
|
#define NOTE_GS6 1661
|
|
|
|
#define NOTE_A6 1760
|
|
|
|
#define NOTE_AS6 1865
|
|
|
|
#define NOTE_B6 1976
|
|
|
|
#define NOTE_C7 2093
|
|
|
|
#define NOTE_CS7 2217
|
|
|
|
#define NOTE_D7 2349
|
|
|
|
#define NOTE_DS7 2489
|
|
|
|
#define NOTE_E7 2637
|
|
|
|
#define NOTE_F7 2794
|
|
|
|
#define NOTE_FS7 2960
|
|
|
|
#define NOTE_G7 3136
|
|
|
|
#define NOTE_GS7 3322
|
|
|
|
#define NOTE_A7 3520
|
|
|
|
#define NOTE_AS7 3729
|
|
|
|
#define NOTE_B7 3951
|
|
|
|
#define NOTE_C8 4186
|
|
|
|
#define NOTE_CS8 4435
|
|
|
|
#define NOTE_D8 4699
|
|
|
|
#define NOTE_DS8 4978
|
|
|
|
|
|
|
|
#define TONE_STARTUP_TUNE 0
|
|
|
|
#define TONE_ERROR_TUNE 1
|
|
|
|
#define TONE_NOTIFY_POSITIVE_TUNE 2
|
|
|
|
#define TONE_NOTIFY_NEUTRAL_TUNE 3
|
|
|
|
#define TONE_NOTIFY_NEGATIVE_TUNE 4
|
|
|
|
#define TONE_ARMING_WARNING_TUNE 5
|
|
|
|
#define TONE_BATTERY_WARNING_SLOW_TUNE 6
|
|
|
|
#define TONE_BATTERY_WARNING_FAST_TUNE 7
|
|
|
|
#define TONE_GPS_WARNING_TUNE 8
|
|
|
|
#define TONE_ARMING_FAILURE_TUNE 9
|
|
|
|
#define TONE_PARACHUTE_RELEASE_TUNE 10
|
|
|
|
|
|
|
|
#define TONE_NUMBER_OF_TUNES 11
|
|
|
|
|
2018-03-01 20:46:30 -04:00
|
|
|
#ifdef HAL_PWM_ALARM
|
|
|
|
|
2018-01-28 14:31:21 -04:00
|
|
|
namespace ChibiOS {
|
|
|
|
|
|
|
|
class ToneAlarm {
|
|
|
|
public:
|
2018-02-01 11:25:03 -04:00
|
|
|
ToneAlarm();
|
|
|
|
void set_tune(uint8_t tone);
|
|
|
|
virtual bool init();
|
|
|
|
virtual void stop();
|
|
|
|
virtual bool play();
|
|
|
|
bool is_tune_comp();
|
|
|
|
bool set_note();
|
|
|
|
bool init_tune();
|
2018-01-28 14:31:21 -04:00
|
|
|
|
|
|
|
protected:
|
2018-02-01 11:25:03 -04:00
|
|
|
bool tune_comp;
|
|
|
|
static const char *tune[TONE_NUMBER_OF_TUNES];
|
|
|
|
static bool tune_repeat[TONE_NUMBER_OF_TUNES];
|
|
|
|
bool tune_changed;
|
|
|
|
uint8_t default_oct;
|
|
|
|
uint8_t default_dur;
|
|
|
|
uint16_t bpm;
|
|
|
|
uint16_t wholenote;
|
|
|
|
uint16_t cur_note;
|
|
|
|
uint16_t duration;
|
|
|
|
int32_t prev_tune_num;
|
|
|
|
uint32_t prev_time;
|
|
|
|
int8_t tune_num;
|
|
|
|
uint8_t tune_pos;
|
2018-01-28 14:31:21 -04:00
|
|
|
|
|
|
|
private:
|
|
|
|
struct pwmGroup {
|
2018-02-01 11:25:03 -04:00
|
|
|
pwmchannel_t chan;
|
2018-01-28 14:31:21 -04:00
|
|
|
PWMConfig pwm_cfg;
|
|
|
|
PWMDriver* pwm_drv;
|
|
|
|
};
|
|
|
|
static pwmGroup pwm_group;
|
|
|
|
};
|
|
|
|
|
|
|
|
}
|
2018-03-01 20:46:30 -04:00
|
|
|
#endif // HAL_PWM_ALARM
|