mirror of
https://github.com/ArduPilot/ardupilot
synced 2025-01-08 08:58:29 -04:00
af203760bd
This is a part of a set of fixes for the bugs and typos tridge discovered and shared inside earlier commits for setting up tonealarm.
157 lines
3.5 KiB
C++
157 lines
3.5 KiB
C++
|
|
#ifndef __AP_HAL_LINUX_UTIL_H__
|
|
#define __AP_HAL_LINUX_UTIL_H__
|
|
|
|
#include <AP_HAL.h>
|
|
#include "AP_HAL_Linux_Namespace.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
|
|
|
|
class Linux::LinuxUtil : public AP_HAL::Util {
|
|
public:
|
|
void init(int argc, char * const *argv) {
|
|
saved_argc = argc;
|
|
saved_argv = argv;
|
|
toneAlarm();
|
|
}
|
|
|
|
|
|
bool run_debug_shell(AP_HAL::BetterStream *stream) { return false; }
|
|
|
|
/**
|
|
return commandline arguments, if available
|
|
*/
|
|
void commandline_arguments(uint8_t &argc, char * const *&argv);
|
|
|
|
int8_t toneAlarm_init();
|
|
void toneAlarm_set_tune(uint8_t tune);
|
|
|
|
void _toneAlarm_timer_tick();
|
|
|
|
private:
|
|
void toneAlarm(void);
|
|
void stop();
|
|
void play(int tone,int duration);
|
|
void play_tune();
|
|
|
|
const char *tune[TONE_NUMBER_OF_TUNES];
|
|
bool tune_repeat[TONE_NUMBER_OF_TUNES];
|
|
bool tune_changed;
|
|
uint32_t prev_tune_num;
|
|
int32_t period_fd;
|
|
int32_t duty_fd;
|
|
int32_t run_fd;
|
|
uint8_t tune_num;
|
|
|
|
int saved_argc;
|
|
char* const *saved_argv;
|
|
};
|
|
|
|
|
|
|
|
#endif // __AP_HAL_LINUX_UTIL_H__
|