mirror of
https://github.com/EdgeTX/edgetx.git
synced 2025-07-23 16:25:12 +03:00
1268 lines
42 KiB
C++
1268 lines
42 KiB
C++
/*
|
|
* Copyright (C) OpenTX
|
|
*
|
|
* Based on code named
|
|
* th9x - http://code.google.com/p/th9x
|
|
* er9x - http://code.google.com/p/er9x
|
|
* gruvin9x - http://code.google.com/p/gruvin9x
|
|
*
|
|
* License GPLv2: http://www.gnu.org/licenses/gpl-2.0.html
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
* published by the Free Software Foundation.
|
|
*
|
|
* 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.
|
|
*/
|
|
|
|
#include "opentx.h"
|
|
#include <math.h>
|
|
|
|
extern RTOS_MUTEX_HANDLE audioMutex;
|
|
|
|
const int16_t sineValues[] =
|
|
{
|
|
0, 196, 392, 588, 784, 980, 1175, 1370, 1564, 1758,
|
|
1951, 2143, 2335, 2525, 2715, 2904, 3091, 3278, 3463, 3647,
|
|
3829, 4011, 4190, 4369, 4545, 4720, 4894, 5065, 5235, 5403,
|
|
5569, 5733, 5895, 6055, 6213, 6369, 6522, 6673, 6822, 6969,
|
|
7113, 7255, 7395, 7532, 7667, 7799, 7929, 8056, 8180, 8302,
|
|
8422, 8539, 8653, 8765, 8874, 8980, 9084, 9185, 9283, 9379,
|
|
9472, 9562, 9650, 9735, 9818, 9898, 9975, 10050, 10123, 10192,
|
|
10260, 10324, 10387, 10447, 10504, 10559, 10612, 10663, 10711, 10757,
|
|
10801, 10843, 10882, 10920, 10955, 10989, 11020, 11050, 11078, 11104,
|
|
11128, 11151, 11172, 11191, 11209, 11225, 11240, 11254, 11266, 11277,
|
|
11287, 11296, 11303, 11310, 11316, 11320, 11324, 11327, 11330, 11331,
|
|
11332, 11333, 11333, 11333, 11332, 11331, 11329, 11328, 11326, 11324,
|
|
11323, 11321, 11319, 11318, 11316, 11315, 11314, 11313, 11313, 11313,
|
|
11314, 11315, 11317, 11319, 11323, 11326, 11331, 11336, 11342, 11349,
|
|
11356, 11365, 11375, 11385, 11397, 11409, 11423, 11437, 11453, 11470,
|
|
11488, 11507, 11527, 11548, 11571, 11595, 11620, 11646, 11673, 11702,
|
|
11732, 11763, 11795, 11828, 11863, 11899, 11936, 11974, 12013, 12054,
|
|
12095, 12138, 12182, 12227, 12273, 12320, 12368, 12417, 12467, 12518,
|
|
12570, 12623, 12676, 12731, 12786, 12842, 12898, 12956, 13014, 13072,
|
|
13131, 13191, 13251, 13311, 13372, 13433, 13495, 13556, 13618, 13680,
|
|
13743, 13805, 13867, 13929, 13991, 14053, 14115, 14177, 14238, 14299,
|
|
14359, 14419, 14479, 14538, 14597, 14655, 14712, 14768, 14824, 14879,
|
|
14933, 14986, 15039, 15090, 15140, 15189, 15237, 15284, 15330, 15375,
|
|
15418, 15460, 15500, 15539, 15577, 15614, 15648, 15682, 15714, 15744,
|
|
15772, 15799, 15825, 15849, 15871, 15891, 15910, 15927, 15942, 15955,
|
|
15967, 15977, 15985, 15991, 15996, 15999, 16000, 15999, 15996, 15991,
|
|
15985, 15977, 15967, 15955, 15942, 15927, 15910, 15891, 15871, 15849,
|
|
15825, 15799, 15772, 15744, 15714, 15682, 15648, 15614, 15577, 15539,
|
|
15500, 15460, 15418, 15375, 15330, 15284, 15237, 15189, 15140, 15090,
|
|
15039, 14986, 14933, 14879, 14824, 14768, 14712, 14655, 14597, 14538,
|
|
14479, 14419, 14359, 14299, 14238, 14177, 14115, 14053, 13991, 13929,
|
|
13867, 13805, 13743, 13680, 13618, 13556, 13495, 13433, 13372, 13311,
|
|
13251, 13191, 13131, 13072, 13014, 12956, 12898, 12842, 12786, 12731,
|
|
12676, 12623, 12570, 12518, 12467, 12417, 12368, 12320, 12273, 12227,
|
|
12182, 12138, 12095, 12054, 12013, 11974, 11936, 11899, 11863, 11828,
|
|
11795, 11763, 11732, 11702, 11673, 11646, 11620, 11595, 11571, 11548,
|
|
11527, 11507, 11488, 11470, 11453, 11437, 11423, 11409, 11397, 11385,
|
|
11375, 11365, 11356, 11349, 11342, 11336, 11331, 11326, 11323, 11319,
|
|
11317, 11315, 11314, 11313, 11313, 11313, 11314, 11315, 11316, 11318,
|
|
11319, 11321, 11323, 11324, 11326, 11328, 11329, 11331, 11332, 11333,
|
|
11333, 11333, 11332, 11331, 11330, 11327, 11324, 11320, 11316, 11310,
|
|
11303, 11296, 11287, 11277, 11266, 11254, 11240, 11225, 11209, 11191,
|
|
11172, 11151, 11128, 11104, 11078, 11050, 11020, 10989, 10955, 10920,
|
|
10882, 10843, 10801, 10757, 10711, 10663, 10612, 10559, 10504, 10447,
|
|
10387, 10324, 10260, 10192, 10123, 10050, 9975, 9898, 9818, 9735,
|
|
9650, 9562, 9472, 9379, 9283, 9185, 9084, 8980, 8874, 8765,
|
|
8653, 8539, 8422, 8302, 8180, 8056, 7929, 7799, 7667, 7532,
|
|
7395, 7255, 7113, 6969, 6822, 6673, 6522, 6369, 6213, 6055,
|
|
5895, 5733, 5569, 5403, 5235, 5065, 4894, 4720, 4545, 4369,
|
|
4190, 4011, 3829, 3647, 3463, 3278, 3091, 2904, 2715, 2525,
|
|
2335, 2143, 1951, 1758, 1564, 1370, 1175, 980, 784, 588,
|
|
392, 196, 0, -196, -392, -588, -784, -980, -1175, -1370,
|
|
-1564, -1758, -1951, -2143, -2335, -2525, -2715, -2904, -3091, -3278,
|
|
-3463, -3647, -3829, -4011, -4190, -4369, -4545, -4720, -4894, -5065,
|
|
-5235, -5403, -5569, -5733, -5895, -6055, -6213, -6369, -6522, -6673,
|
|
-6822, -6969, -7113, -7255, -7395, -7532, -7667, -7799, -7929, -8056,
|
|
-8180, -8302, -8422, -8539, -8653, -8765, -8874, -8980, -9084, -9185,
|
|
-9283, -9379, -9472, -9562, -9650, -9735, -9818, -9898, -9975, -10050,
|
|
-10123, -10192, -10260, -10324, -10387, -10447, -10504, -10559, -10612, -10663,
|
|
-10711, -10757, -10801, -10843, -10882, -10920, -10955, -10989, -11020, -11050,
|
|
-11078, -11104, -11128, -11151, -11172, -11191, -11209, -11225, -11240, -11254,
|
|
-11266, -11277, -11287, -11296, -11303, -11310, -11316, -11320, -11324, -11327,
|
|
-11330, -11331, -11332, -11333, -11333, -11333, -11332, -11331, -11329, -11328,
|
|
-11326, -11324, -11323, -11321, -11319, -11318, -11316, -11315, -11314, -11313,
|
|
-11313, -11313, -11314, -11315, -11317, -11319, -11323, -11326, -11331, -11336,
|
|
-11342, -11349, -11356, -11365, -11375, -11385, -11397, -11409, -11423, -11437,
|
|
-11453, -11470, -11488, -11507, -11527, -11548, -11571, -11595, -11620, -11646,
|
|
-11673, -11702, -11732, -11763, -11795, -11828, -11863, -11899, -11936, -11974,
|
|
-12013, -12054, -12095, -12138, -12182, -12227, -12273, -12320, -12368, -12417,
|
|
-12467, -12518, -12570, -12623, -12676, -12731, -12786, -12842, -12898, -12956,
|
|
-13014, -13072, -13131, -13191, -13251, -13311, -13372, -13433, -13495, -13556,
|
|
-13618, -13680, -13743, -13805, -13867, -13929, -13991, -14053, -14115, -14177,
|
|
-14238, -14299, -14359, -14419, -14479, -14538, -14597, -14655, -14712, -14768,
|
|
-14824, -14879, -14933, -14986, -15039, -15090, -15140, -15189, -15237, -15284,
|
|
-15330, -15375, -15418, -15460, -15500, -15539, -15577, -15614, -15648, -15682,
|
|
-15714, -15744, -15772, -15799, -15825, -15849, -15871, -15891, -15910, -15927,
|
|
-15942, -15955, -15967, -15977, -15985, -15991, -15996, -15999, -16000, -15999,
|
|
-15996, -15991, -15985, -15977, -15967, -15955, -15942, -15927, -15910, -15891,
|
|
-15871, -15849, -15825, -15799, -15772, -15744, -15714, -15682, -15648, -15614,
|
|
-15577, -15539, -15500, -15460, -15418, -15375, -15330, -15284, -15237, -15189,
|
|
-15140, -15090, -15039, -14986, -14933, -14879, -14824, -14768, -14712, -14655,
|
|
-14597, -14538, -14479, -14419, -14359, -14299, -14238, -14177, -14115, -14053,
|
|
-13991, -13929, -13867, -13805, -13743, -13680, -13618, -13556, -13495, -13433,
|
|
-13372, -13311, -13251, -13191, -13131, -13072, -13014, -12956, -12898, -12842,
|
|
-12786, -12731, -12676, -12623, -12570, -12518, -12467, -12417, -12368, -12320,
|
|
-12273, -12227, -12182, -12138, -12095, -12054, -12013, -11974, -11936, -11899,
|
|
-11863, -11828, -11795, -11763, -11732, -11702, -11673, -11646, -11620, -11595,
|
|
-11571, -11548, -11527, -11507, -11488, -11470, -11453, -11437, -11423, -11409,
|
|
-11397, -11385, -11375, -11365, -11356, -11349, -11342, -11336, -11331, -11326,
|
|
-11323, -11319, -11317, -11315, -11314, -11313, -11313, -11313, -11314, -11315,
|
|
-11316, -11318, -11319, -11321, -11323, -11324, -11326, -11328, -11329, -11331,
|
|
-11332, -11333, -11333, -11333, -11332, -11331, -11330, -11327, -11324, -11320,
|
|
-11316, -11310, -11303, -11296, -11287, -11277, -11266, -11254, -11240, -11225,
|
|
-11209, -11191, -11172, -11151, -11128, -11104, -11078, -11050, -11020, -10989,
|
|
-10955, -10920, -10882, -10843, -10801, -10757, -10711, -10663, -10612, -10559,
|
|
-10504, -10447, -10387, -10324, -10260, -10192, -10123, -10050, -9975, -9898,
|
|
-9818, -9735, -9650, -9562, -9472, -9379, -9283, -9185, -9084, -8980,
|
|
-8874, -8765, -8653, -8539, -8422, -8302, -8180, -8056, -7929, -7799,
|
|
-7667, -7532, -7395, -7255, -7113, -6969, -6822, -6673, -6522, -6369,
|
|
-6213, -6055, -5895, -5733, -5569, -5403, -5235, -5065, -4894, -4720,
|
|
-4545, -4369, -4190, -4011, -3829, -3647, -3463, -3278, -3091, -2904,
|
|
-2715, -2525, -2335, -2143, -1951, -1758, -1564, -1370, -1175, -980,
|
|
-784, -588, -392, -196,
|
|
};
|
|
|
|
#if defined(SDCARD)
|
|
|
|
const char * const unitsFilenames[] = {
|
|
"",
|
|
"volt",
|
|
"amp",
|
|
"mamp",
|
|
"knot",
|
|
"mps",
|
|
"fps",
|
|
"kph",
|
|
"mph",
|
|
"meter",
|
|
"foot",
|
|
"celsius",
|
|
"fahr",
|
|
"percent",
|
|
"mamph",
|
|
"watt",
|
|
"mwatt",
|
|
"db",
|
|
"rpm",
|
|
"g",
|
|
"degree",
|
|
"radian",
|
|
"ml",
|
|
"founce",
|
|
"mlpm",
|
|
"hertz",
|
|
"ms",
|
|
"us",
|
|
"spare4",
|
|
"spare5",
|
|
"spare6",
|
|
"spare7",
|
|
"spare8",
|
|
"spare9",
|
|
"spare10",
|
|
"hour",
|
|
"minute",
|
|
"second",
|
|
};
|
|
|
|
const char * const audioFilenames[] = {
|
|
"hello",
|
|
"bye",
|
|
"thralert",
|
|
"swalert",
|
|
"baddata",
|
|
"lowbatt",
|
|
"inactiv",
|
|
"rssi_org",
|
|
"rssi_red",
|
|
"swr_red",
|
|
"telemko",
|
|
"telemok",
|
|
"trainko",
|
|
"trainok",
|
|
"sensorko",
|
|
"servoko",
|
|
"rxko",
|
|
"modelpwr",
|
|
#if defined(PCBSKY9X)
|
|
"highmah",
|
|
"hightemp",
|
|
#endif
|
|
"error",
|
|
"warning1",
|
|
"warning2",
|
|
"warning3",
|
|
"midtrim",
|
|
"mintrim",
|
|
"maxtrim",
|
|
"midstck1",
|
|
"midstck2",
|
|
"midstck3",
|
|
"midstck4",
|
|
#if defined(PCBFRSKY)
|
|
"midpot1",
|
|
"midpot2",
|
|
#if defined(PCBX9E)
|
|
"midpot3",
|
|
"midpot4",
|
|
#endif
|
|
"midslid1",
|
|
"midslid2",
|
|
#if defined(PCBX9E)
|
|
"midslid3",
|
|
"midslid4",
|
|
#endif
|
|
#else
|
|
"midpot1",
|
|
"midpot2",
|
|
"midpot3",
|
|
#endif
|
|
"mixwarn1",
|
|
"mixwarn2",
|
|
"mixwarn3",
|
|
"timovr1",
|
|
"timovr2",
|
|
"timovr3"
|
|
};
|
|
|
|
BitField<(AU_SPECIAL_SOUND_FIRST)> sdAvailableSystemAudioFiles;
|
|
BitField<(MAX_FLIGHT_MODES * 2/*on, off*/)> sdAvailableFlightmodeAudioFiles;
|
|
BitField<(SWSRC_LAST_SWITCH+NUM_XPOTS*XPOTS_MULTIPOS_COUNT)> sdAvailableSwitchAudioFiles;
|
|
BitField<(MAX_LOGICAL_SWITCHES * 2/*on, off*/)> sdAvailableLogicalSwitchAudioFiles;
|
|
|
|
char * getAudioPath(char * path)
|
|
{
|
|
strcpy(path, SOUNDS_PATH "/");
|
|
strncpy(path+SOUNDS_PATH_LNG_OFS, currentLanguagePack->id, 2);
|
|
return path + sizeof(SOUNDS_PATH);
|
|
}
|
|
|
|
char * strAppendSystemAudioPath(char * path)
|
|
{
|
|
char * str = getAudioPath(path);
|
|
strcpy(str, SYSTEM_SUBDIR "/");
|
|
return str + sizeof(SYSTEM_SUBDIR);
|
|
}
|
|
|
|
void getSystemAudioFile(char * filename, int index)
|
|
{
|
|
char * str = strAppendSystemAudioPath(filename);
|
|
strcpy(str, audioFilenames[index]);
|
|
strcat(str, SOUNDS_EXT);
|
|
}
|
|
|
|
void referenceSystemAudioFiles()
|
|
{
|
|
static_assert(sizeof(audioFilenames)==AU_SPECIAL_SOUND_FIRST*sizeof(char *), "Invalid audioFilenames size");
|
|
char path[AUDIO_FILENAME_MAXLEN+1];
|
|
FILINFO fno;
|
|
DIR dir;
|
|
|
|
sdAvailableSystemAudioFiles.reset();
|
|
|
|
char * filename = strAppendSystemAudioPath(path);
|
|
*(filename-1) = '\0';
|
|
|
|
FRESULT res = f_opendir(&dir, path); /* Open the directory */
|
|
if (res == FR_OK) {
|
|
for (;;) {
|
|
res = f_readdir(&dir, &fno); /* Read a directory item */
|
|
if (res != FR_OK || fno.fname[0] == 0) break; /* Break on error or end of dir */
|
|
uint8_t len = strlen(fno.fname);
|
|
|
|
// Eliminates directories / non wav files
|
|
if (len < 5 || strcasecmp(fno.fname+len-4, SOUNDS_EXT) || (fno.fattrib & AM_DIR)) continue;
|
|
|
|
for (int i=0; i<AU_SPECIAL_SOUND_FIRST; i++) {
|
|
getSystemAudioFile(path, i);
|
|
if (!strcasecmp(filename, fno.fname)) {
|
|
sdAvailableSystemAudioFiles.setBit(i);
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
f_closedir(&dir);
|
|
}
|
|
}
|
|
|
|
const char * const suffixes[] = { "-off", "-on" };
|
|
|
|
char * getModelAudioPath(char * path)
|
|
{
|
|
strcpy(path, SOUNDS_PATH "/");
|
|
strncpy(path+SOUNDS_PATH_LNG_OFS, currentLanguagePack->id, 2);
|
|
char * result = strcat_currentmodelname(path+sizeof(SOUNDS_PATH));
|
|
*result++ = '/';
|
|
*result = '\0';
|
|
return result;
|
|
}
|
|
|
|
void getFlightmodeAudioFile(char * filename, int index, unsigned int event)
|
|
{
|
|
char * str = getModelAudioPath(filename);
|
|
char * tmp = strcatFlightmodeName(str, index);
|
|
strcpy(tmp, suffixes[event]);
|
|
strcat(tmp, SOUNDS_EXT);
|
|
}
|
|
|
|
void getSwitchAudioFile(char * filename, swsrc_t index)
|
|
{
|
|
char * str = getModelAudioPath(filename);
|
|
|
|
#if defined(PCBFRSKY)
|
|
if (index <= SWSRC_LAST_SWITCH) {
|
|
div_t swinfo = switchInfo(index);
|
|
*str++ = 'S';
|
|
*str++ = 'A' + swinfo.quot;
|
|
const char * positions[] = { "-up", "-mid", "-down" };
|
|
strcpy(str, positions[swinfo.rem]);
|
|
}
|
|
else {
|
|
div_t swinfo = div(int(index - SWSRC_FIRST_MULTIPOS_SWITCH), XPOTS_MULTIPOS_COUNT);
|
|
*str++ = 'S';
|
|
*str++ = '1' + swinfo.quot;
|
|
*str++ = '1' + swinfo.rem;
|
|
*str = '\0';
|
|
}
|
|
#else
|
|
int len = STR_VSWITCHES[0];
|
|
strncpy(str, &STR_VSWITCHES[1+(len*index)], len);
|
|
str += len;
|
|
*str = '\0';
|
|
#endif
|
|
strcat(str, SOUNDS_EXT);
|
|
}
|
|
|
|
void getLogicalSwitchAudioFile(char * filename, int index, unsigned int event)
|
|
{
|
|
char * str = getModelAudioPath(filename);
|
|
|
|
#if defined(PCBFRSKY)
|
|
*str++ = 'L';
|
|
if (index >= 9) {
|
|
div_t qr = div(index+1, 10);
|
|
*str++ = '0' + qr.quot;
|
|
*str++ = '0' + qr.rem;
|
|
}
|
|
else {
|
|
*str++ = '1' + index;
|
|
}
|
|
#else
|
|
int len = STR_VSWITCHES[0];
|
|
strncpy(str, &STR_VSWITCHES[1+len*(index+SWSRC_FIRST_LOGICAL_SWITCH)], len);
|
|
str += len;
|
|
#endif
|
|
|
|
strcpy(str, suffixes[event]);
|
|
strcat(str, SOUNDS_EXT);
|
|
}
|
|
|
|
void referenceModelAudioFiles()
|
|
{
|
|
char path[AUDIO_FILENAME_MAXLEN+1];
|
|
FILINFO fno;
|
|
DIR dir;
|
|
|
|
sdAvailableFlightmodeAudioFiles.reset();
|
|
sdAvailableSwitchAudioFiles.reset();
|
|
sdAvailableLogicalSwitchAudioFiles.reset();
|
|
|
|
char * filename = getModelAudioPath(path);
|
|
*(filename-1) = '\0';
|
|
|
|
FRESULT res = f_opendir(&dir, path); /* Open the directory */
|
|
if (res == FR_OK) {
|
|
for (;;) {
|
|
res = f_readdir(&dir, &fno); /* Read a directory item */
|
|
if (res != FR_OK || fno.fname[0] == 0) break; /* Break on error or end of dir */
|
|
uint8_t len = strlen(fno.fname);
|
|
bool found = false;
|
|
|
|
// Eliminates directories / non wav files
|
|
if (len < 5 || strcasecmp(fno.fname+len-4, SOUNDS_EXT) || (fno.fattrib & AM_DIR)) continue;
|
|
TRACE("referenceModelAudioFiles(): using file: %s", fno.fname);
|
|
|
|
// Flight modes Audio Files <flightmodename>-[on|off].wav
|
|
for (int i=0; i<MAX_FLIGHT_MODES && !found; i++) {
|
|
for (int event=0; event<2; event++) {
|
|
getFlightmodeAudioFile(path, i, event);
|
|
// TRACE("referenceModelAudioFiles(): searching for %s in %s", filename, fno.fname);
|
|
if (!strcasecmp(filename, fno.fname)) {
|
|
sdAvailableFlightmodeAudioFiles.setBit(INDEX_PHASE_AUDIO_FILE(i, event));
|
|
found = true;
|
|
TRACE("\tfound: %s", filename);
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
// Switches Audio Files <switchname>-[up|mid|down].wav
|
|
for (int i=SWSRC_FIRST_SWITCH; i<=SWSRC_LAST_SWITCH+NUM_XPOTS*XPOTS_MULTIPOS_COUNT && !found; i++) {
|
|
getSwitchAudioFile(path, i);
|
|
// TRACE("referenceModelAudioFiles(): searching for %s in %s (%d)", path, fno.fname, i);
|
|
if (!strcasecmp(filename, fno.fname)) {
|
|
sdAvailableSwitchAudioFiles.setBit(i-SWSRC_FIRST_SWITCH);
|
|
found = true;
|
|
TRACE("\tfound: %s", filename);
|
|
}
|
|
}
|
|
|
|
// Logical Switches Audio Files <switchname>-[on|off].wav
|
|
for (int i=0; i<MAX_LOGICAL_SWITCHES && !found; i++) {
|
|
for (int event=0; event<2; event++) {
|
|
getLogicalSwitchAudioFile(path, i, event);
|
|
// TRACE("referenceModelAudioFiles(): searching for %s in %s", filename, fno.fname);
|
|
if (!strcasecmp(filename, fno.fname)) {
|
|
sdAvailableLogicalSwitchAudioFiles.setBit(INDEX_LOGICAL_SWITCH_AUDIO_FILE(i, event));
|
|
found = true;
|
|
TRACE("\tfound: %s", filename);
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
f_closedir(&dir);
|
|
}
|
|
}
|
|
|
|
bool isAudioFileReferenced(uint32_t i, char * filename)
|
|
{
|
|
uint8_t category = (i >> 24);
|
|
uint8_t index = (i >> 16) & 0xFF;
|
|
event_t event = i & 0xFF;
|
|
|
|
// TRACE("isAudioFileReferenced(%08x)", i);
|
|
|
|
if (category == SYSTEM_AUDIO_CATEGORY) {
|
|
if (sdAvailableSystemAudioFiles.getBit(event)) {
|
|
getSystemAudioFile(filename, event);
|
|
return true;
|
|
}
|
|
}
|
|
else if (category == PHASE_AUDIO_CATEGORY) {
|
|
if (sdAvailableFlightmodeAudioFiles.getBit(INDEX_PHASE_AUDIO_FILE(index, event))) {
|
|
getFlightmodeAudioFile(filename, index, event);
|
|
return true;
|
|
}
|
|
}
|
|
else if (category == SWITCH_AUDIO_CATEGORY) {
|
|
if (sdAvailableSwitchAudioFiles.getBit(index)) {
|
|
getSwitchAudioFile(filename, SWSRC_FIRST_SWITCH+index);
|
|
return true;
|
|
}
|
|
}
|
|
else if (category == LOGICAL_SWITCH_AUDIO_CATEGORY) {
|
|
if (sdAvailableLogicalSwitchAudioFiles.getBit(INDEX_LOGICAL_SWITCH_AUDIO_FILE(index, event))) {
|
|
getLogicalSwitchAudioFile(filename, index, event);
|
|
return true;
|
|
}
|
|
}
|
|
|
|
return false;
|
|
}
|
|
|
|
tmr10ms_t timeAutomaticPromptsSilence = 0;
|
|
|
|
void playModelEvent(uint8_t category, uint8_t index, event_t event)
|
|
{
|
|
char filename[AUDIO_FILENAME_MAXLEN+1];
|
|
// TRACE("playModelEvent(): cat: %u, idx: %u, evt:%u", (uint32_t)category, (uint32_t)index, (uint32_t)event);
|
|
if (IS_SILENCE_PERIOD_ELAPSED() && isAudioFileReferenced((category << 24) + (index << 16) + event, filename)) {
|
|
audioQueue.playFile(filename);
|
|
}
|
|
}
|
|
|
|
void playModelName()
|
|
{
|
|
char filename[AUDIO_FILENAME_MAXLEN+1];
|
|
char * str = getModelAudioPath(filename);
|
|
strcpy(str, "name.wav");
|
|
audioQueue.playFile(filename);
|
|
}
|
|
|
|
#else // defined(SDCARD)
|
|
|
|
#define isAudioFileReferenced(i, f) false
|
|
|
|
#endif // defined(SDCARD)
|
|
|
|
const int16_t alawTable[256] = { -5504, -5248, -6016, -5760, -4480, -4224, -4992, -4736, -7552, -7296, -8064, -7808, -6528, -6272, -7040, -6784, -2752, -2624, -3008, -2880, -2240, -2112, -2496, -2368, -3776, -3648, -4032, -3904, -3264, -3136, -3520, -3392, -22016, -20992, -24064, -23040, -17920, -16896, -19968, -18944, -30208, -29184, -32256, -31232, -26112, -25088, -28160, -27136, -11008, -10496, -12032, -11520, -8960, -8448, -9984, -9472, -15104, -14592, -16128, -15616, -13056, -12544, -14080, -13568, -344, -328, -376, -360, -280, -264, -312, -296, -472, -456, -504, -488, -408, -392, -440, -424, -88, -72, -120, -104, -24, -8, -56, -40, -216, -200, -248, -232, -152, -136, -184, -168, -1376, -1312, -1504, -1440, -1120, -1056, -1248, -1184, -1888, -1824, -2016, -1952, -1632, -1568, -1760, -1696, -688, -656, -752, -720, -560, -528, -624, -592, -944, -912, -1008, -976, -816, -784, -880, -848, 5504, 5248, 6016, 5760, 4480, 4224, 4992, 4736, 7552, 7296, 8064, 7808, 6528, 6272, 7040, 6784, 2752, 2624, 3008, 2880, 2240, 2112, 2496, 2368, 3776, 3648, 4032, 3904, 3264, 3136, 3520, 3392, 22016, 20992, 24064, 23040, 17920, 16896, 19968, 18944, 30208, 29184, 32256, 31232, 26112, 25088, 28160, 27136, 11008, 10496, 12032, 11520, 8960, 8448, 9984, 9472, 15104, 14592, 16128, 15616, 13056, 12544, 14080, 13568, 344, 328, 376, 360, 280, 264, 312, 296, 472, 456, 504, 488, 408, 392, 440, 424, 88, 72, 120, 104, 24, 8, 56, 40, 216, 200, 248, 232, 152, 136, 184, 168, 1376, 1312, 1504, 1440, 1120, 1056, 1248, 1184, 1888, 1824, 2016, 1952, 1632, 1568, 1760, 1696, 688, 656, 752, 720, 560, 528, 624, 592, 944, 912, 1008, 976, 816, 784, 880, 848 };
|
|
const int16_t ulawTable[256] = { -32124, -31100, -30076, -29052, -28028, -27004, -25980, -24956, -23932, -22908, -21884, -20860, -19836, -18812, -17788, -16764, -15996, -15484, -14972, -14460, -13948, -13436, -12924, -12412, -11900, -11388, -10876, -10364, -9852, -9340, -8828, -8316, -7932, -7676, -7420, -7164, -6908, -6652, -6396, -6140, -5884, -5628, -5372, -5116, -4860, -4604, -4348, -4092, -3900, -3772, -3644, -3516, -3388, -3260, -3132, -3004, -2876, -2748, -2620, -2492, -2364, -2236, -2108, -1980, -1884, -1820, -1756, -1692, -1628, -1564, -1500, -1436, -1372, -1308, -1244, -1180, -1116, -1052, -988, -924, -876, -844, -812, -780, -748, -716, -684, -652, -620, -588, -556, -524, -492, -460, -428, -396, -372, -356, -340, -324, -308, -292, -276, -260, -244, -228, -212, -196, -180, -164, -148, -132, -120, -112, -104, -96, -88, -80, -72, -64, -56, -48, -40, -32, -24, -16, -8, 0, 32124, 31100, 30076, 29052, 28028, 27004, 25980, 24956, 23932, 22908, 21884, 20860, 19836, 18812, 17788, 16764, 15996, 15484, 14972, 14460, 13948, 13436, 12924, 12412, 11900, 11388, 10876, 10364, 9852, 9340, 8828, 8316, 7932, 7676, 7420, 7164, 6908, 6652, 6396, 6140, 5884, 5628, 5372, 5116, 4860, 4604, 4348, 4092, 3900, 3772, 3644, 3516, 3388, 3260, 3132, 3004, 2876, 2748, 2620, 2492, 2364, 2236, 2108, 1980, 1884, 1820, 1756, 1692, 1628, 1564, 1500, 1436, 1372, 1308, 1244, 1180, 1116, 1052, 988, 924, 876, 844, 812, 780, 748, 716, 684, 652, 620, 588, 556, 524, 492, 460, 428, 396, 372, 356, 340, 324, 308, 292, 276, 260, 244, 228, 212, 196, 180, 164, 148, 132, 120, 112, 104, 96, 88, 80, 72, 64, 56, 48, 40, 32, 24, 16, 8, 0 };
|
|
|
|
AudioQueue audioQueue __DMA; // to place it in the RAM section on Horus, to have file buffers in RAM for DMA access
|
|
AudioBuffer audioBuffers[AUDIO_BUFFER_COUNT] __DMA;
|
|
|
|
AudioQueue::AudioQueue()
|
|
: buffersFifo(),
|
|
_started(false),
|
|
normalContext(),
|
|
backgroundContext(),
|
|
priorityContext(),
|
|
varioContext(),
|
|
fragmentsFifo()
|
|
{
|
|
}
|
|
|
|
#define CODEC_ID_PCM_S16LE 1
|
|
#define CODEC_ID_PCM_ALAW 6
|
|
#define CODEC_ID_PCM_MULAW 7
|
|
|
|
#if !defined(SIMU)
|
|
void audioTask(void * pdata)
|
|
{
|
|
while (!audioQueue.started()) {
|
|
RTOS_WAIT_TICKS(1);
|
|
}
|
|
|
|
setSampleRate(AUDIO_SAMPLE_RATE);
|
|
|
|
if (!globalData.unexpectedShutdown) {
|
|
AUDIO_HELLO();
|
|
}
|
|
|
|
while (true) {
|
|
DEBUG_TIMER_SAMPLE(debugTimerAudioIterval);
|
|
DEBUG_TIMER_START(debugTimerAudioDuration);
|
|
audioQueue.wakeup();
|
|
DEBUG_TIMER_STOP(debugTimerAudioDuration);
|
|
RTOS_WAIT_MS(4);
|
|
}
|
|
}
|
|
#endif
|
|
|
|
inline void mixSample(audio_data_t * result, int sample, unsigned int fade)
|
|
{
|
|
*result = limit(AUDIO_DATA_MIN, *result + ((sample >> fade) >> (16-AUDIO_BITS_PER_SAMPLE)), AUDIO_DATA_MAX);
|
|
}
|
|
|
|
#if defined(SDCARD)
|
|
|
|
#define RIFF_CHUNK_SIZE 12
|
|
uint8_t wavBuffer[AUDIO_BUFFER_SIZE*2] __DMA;
|
|
|
|
int WavContext::mixBuffer(AudioBuffer *buffer, int volume, unsigned int fade)
|
|
{
|
|
FRESULT result = FR_OK;
|
|
UINT read = 0;
|
|
|
|
if (fragment.file[1]) {
|
|
result = f_open(&state.file, fragment.file, FA_OPEN_EXISTING | FA_READ);
|
|
fragment.file[1] = 0;
|
|
if (result == FR_OK) {
|
|
result = f_read(&state.file, wavBuffer, RIFF_CHUNK_SIZE+8, &read);
|
|
if (result == FR_OK && read == RIFF_CHUNK_SIZE+8 && !memcmp(wavBuffer, "RIFF", 4) && !memcmp(wavBuffer+8, "WAVEfmt ", 8)) {
|
|
uint32_t size = *((uint32_t *)(wavBuffer+16));
|
|
result = (size < 256 ? f_read(&state.file, wavBuffer, size+8, &read) : FR_DENIED);
|
|
if (result == FR_OK && read == size+8) {
|
|
state.codec = ((uint16_t *)wavBuffer)[0];
|
|
state.freq = ((uint16_t *)wavBuffer)[2];
|
|
uint32_t *wavSamplesPtr = (uint32_t *)(wavBuffer + size);
|
|
uint32_t size = wavSamplesPtr[1];
|
|
if (state.freq != 0 && state.freq * (AUDIO_SAMPLE_RATE / state.freq) == AUDIO_SAMPLE_RATE) {
|
|
state.resampleRatio = (AUDIO_SAMPLE_RATE / state.freq);
|
|
state.readSize = (state.codec == CODEC_ID_PCM_S16LE ? 2*AUDIO_BUFFER_SIZE : AUDIO_BUFFER_SIZE) / state.resampleRatio;
|
|
}
|
|
else {
|
|
result = FR_DENIED;
|
|
}
|
|
while (result == FR_OK && memcmp(wavSamplesPtr, "data", 4) != 0) {
|
|
result = f_lseek(&state.file, f_tell(&state.file)+size);
|
|
if (result == FR_OK) {
|
|
result = f_read(&state.file, wavBuffer, 8, &read);
|
|
if (read != 8) result = FR_DENIED;
|
|
wavSamplesPtr = (uint32_t *)wavBuffer;
|
|
size = wavSamplesPtr[1];
|
|
}
|
|
}
|
|
state.size = size;
|
|
}
|
|
else {
|
|
result = FR_DENIED;
|
|
}
|
|
}
|
|
else {
|
|
result = FR_DENIED;
|
|
}
|
|
}
|
|
}
|
|
|
|
if (result == FR_OK) {
|
|
read = 0;
|
|
result = f_read(&state.file, wavBuffer, state.readSize, &read);
|
|
if (result == FR_OK) {
|
|
if (read > state.size) {
|
|
read = state.size;
|
|
}
|
|
state.size -= read;
|
|
|
|
if (read != state.readSize) {
|
|
f_close(&state.file);
|
|
fragment.clear();
|
|
}
|
|
|
|
audio_data_t * samples = buffer->data;
|
|
if (state.codec == CODEC_ID_PCM_S16LE) {
|
|
read /= 2;
|
|
for (uint32_t i=0; i<read; i++) {
|
|
for (uint8_t j=0; j<state.resampleRatio; j++) {
|
|
mixSample(samples++, ((int16_t *)wavBuffer)[i], fade+2-volume);
|
|
}
|
|
}
|
|
}
|
|
else if (state.codec == CODEC_ID_PCM_ALAW) {
|
|
for (uint32_t i=0; i<read; i++) {
|
|
for (uint8_t j=0; j<state.resampleRatio; j++) {
|
|
mixSample(samples++, alawTable[wavBuffer[i]], fade+2-volume);
|
|
}
|
|
}
|
|
}
|
|
else if (state.codec == CODEC_ID_PCM_MULAW) {
|
|
for (uint32_t i=0; i<read; i++) {
|
|
for (uint8_t j=0; j<state.resampleRatio; j++) {
|
|
mixSample(samples++, ulawTable[wavBuffer[i]], fade+2-volume);
|
|
}
|
|
}
|
|
}
|
|
|
|
return samples - buffer->data;
|
|
}
|
|
}
|
|
|
|
if (result != FR_OK) {
|
|
clear();
|
|
}
|
|
return 0;
|
|
}
|
|
#else
|
|
int WavContext::mixBuffer(AudioBuffer *buffer, int volume, unsigned int fade)
|
|
{
|
|
return 0;
|
|
}
|
|
#endif
|
|
|
|
const unsigned int toneVolumes[] = { 10, 8, 6, 4, 2 };
|
|
inline float evalVolumeRatio(int freq, int volume)
|
|
{
|
|
float result = toneVolumes[2+volume];
|
|
if (freq < 330) {
|
|
result = (result * freq * freq) / (330 * 330);
|
|
}
|
|
return result;
|
|
}
|
|
|
|
int ToneContext::mixBuffer(AudioBuffer * buffer, int volume, unsigned int fade)
|
|
{
|
|
int duration = 0;
|
|
int result = 0;
|
|
|
|
int remainingDuration = fragment.tone.duration - state.duration;
|
|
if (remainingDuration > 0) {
|
|
int points;
|
|
float toneIdx = state.idx;
|
|
|
|
if (fragment.tone.reset) {
|
|
fragment.tone.reset = 0;
|
|
state.duration = 0;
|
|
state.pause = 0;
|
|
}
|
|
|
|
if (fragment.tone.freq != state.freq) {
|
|
state.freq = fragment.tone.freq;
|
|
state.step = limit<float>(1, float(fragment.tone.freq) * (float(DIM(sineValues))/float(AUDIO_SAMPLE_RATE)), 512);
|
|
state.volume = 1.0f / evalVolumeRatio(fragment.tone.freq, volume);
|
|
}
|
|
|
|
if (fragment.tone.freqIncr) {
|
|
int freqChange = AUDIO_BUFFER_DURATION * fragment.tone.freqIncr;
|
|
if (freqChange > 0) {
|
|
fragment.tone.freq += freqChange;
|
|
if (fragment.tone.freq > BEEP_MAX_FREQ) {
|
|
fragment.tone.freq = BEEP_MAX_FREQ;
|
|
}
|
|
}
|
|
else {
|
|
if (fragment.tone.freq > BEEP_MIN_FREQ - freqChange) {
|
|
fragment.tone.freq += freqChange;
|
|
}
|
|
else {
|
|
fragment.tone.freq = BEEP_MIN_FREQ;
|
|
}
|
|
}
|
|
}
|
|
|
|
if (remainingDuration > AUDIO_BUFFER_DURATION) {
|
|
duration = AUDIO_BUFFER_DURATION;
|
|
points = AUDIO_BUFFER_SIZE;
|
|
}
|
|
else {
|
|
duration = remainingDuration;
|
|
points = (duration * AUDIO_BUFFER_SIZE) / AUDIO_BUFFER_DURATION;
|
|
unsigned int end = toneIdx + (state.step * points);
|
|
if (end > DIM(sineValues))
|
|
end -= (end % DIM(sineValues));
|
|
else
|
|
end = DIM(sineValues);
|
|
points = (float(end) - toneIdx) / state.step;
|
|
}
|
|
|
|
for (int i=0; i<points; i++) {
|
|
int16_t sample = sineValues[int(toneIdx)] * state.volume;
|
|
mixSample(&buffer->data[i], sample, fade);
|
|
toneIdx += state.step;
|
|
if ((unsigned int)toneIdx >= DIM(sineValues))
|
|
toneIdx -= DIM(sineValues);
|
|
}
|
|
|
|
if (remainingDuration > AUDIO_BUFFER_DURATION) {
|
|
state.duration += AUDIO_BUFFER_DURATION;
|
|
state.idx = toneIdx;
|
|
return AUDIO_BUFFER_SIZE;
|
|
}
|
|
else {
|
|
state.duration = 32000; // once the tone is finished, it's not possible to update its frequency and duration
|
|
}
|
|
}
|
|
|
|
remainingDuration = fragment.tone.pause - state.pause;
|
|
if (remainingDuration > 0) {
|
|
result = AUDIO_BUFFER_SIZE;
|
|
state.pause += min<unsigned int>(AUDIO_BUFFER_DURATION-duration, fragment.tone.pause);
|
|
if (fragment.tone.pause > state.pause)
|
|
return result;
|
|
}
|
|
|
|
clear();
|
|
return result;
|
|
}
|
|
|
|
void AudioQueue::wakeup()
|
|
{
|
|
DEBUG_TIMER_START(debugTimerAudioConsume);
|
|
audioConsumeCurrentBuffer();
|
|
DEBUG_TIMER_STOP(debugTimerAudioConsume);
|
|
|
|
AudioBuffer * buffer;
|
|
while ((buffer = buffersFifo.getEmptyBuffer()) != nullptr) {
|
|
int result;
|
|
unsigned int fade = 0;
|
|
int size = 0;
|
|
|
|
// write silence in the buffer
|
|
for (uint32_t i=0; i<AUDIO_BUFFER_SIZE; i++) {
|
|
buffer->data[i] = AUDIO_DATA_SILENCE; /* silence */
|
|
}
|
|
|
|
// mix the priority context (only tones)
|
|
result = priorityContext.mixBuffer(buffer, g_eeGeneral.beepVolume, fade);
|
|
if (result > 0) {
|
|
size = result;
|
|
fade += 1;
|
|
}
|
|
|
|
// mix the normal context (tones and wavs)
|
|
if (normalContext.isEmpty() && !fragmentsFifo.empty()) {
|
|
RTOS_LOCK_MUTEX(audioMutex);
|
|
normalContext.setFragment(fragmentsFifo.get());
|
|
RTOS_UNLOCK_MUTEX(audioMutex);
|
|
}
|
|
result = normalContext.mixBuffer(buffer, g_eeGeneral.beepVolume, g_eeGeneral.wavVolume, fade);
|
|
if (result > 0) {
|
|
size = max(size, result);
|
|
fade += 1;
|
|
}
|
|
|
|
// mix the vario context
|
|
result = varioContext.mixBuffer(buffer, g_eeGeneral.varioVolume, fade);
|
|
if (result > 0) {
|
|
size = max(size, result);
|
|
fade += 1;
|
|
}
|
|
|
|
// mix the background context
|
|
if (isFunctionActive(FUNCTION_BACKGND_MUSIC) && !isFunctionActive(FUNCTION_BACKGND_MUSIC_PAUSE)) {
|
|
result = backgroundContext.mixBuffer(buffer, g_eeGeneral.backgroundVolume, fade);
|
|
if (result > 0) {
|
|
size = max(size, result);
|
|
}
|
|
}
|
|
|
|
// push the buffer if needed
|
|
if (size > 0) {
|
|
// TRACE("pushing buffer %p", buffer);
|
|
buffer->size = size;
|
|
|
|
#if defined(SOFTWARE_VOLUME)
|
|
if (currentSpeakerVolume > 0) {
|
|
for (uint32_t i=0; i<buffer->size; ++i) {
|
|
int32_t tmpSample = (int32_t) ((uint32_t) (buffer->data[i]) - AUDIO_DATA_SILENCE); // conversion from uint16_t
|
|
buffer->data[i] = (int16_t) (((tmpSample * currentSpeakerVolume) / VOLUME_LEVEL_MAX) + AUDIO_DATA_SILENCE);
|
|
}
|
|
buffersFifo.audioPushBuffer();
|
|
}
|
|
else {
|
|
break;
|
|
}
|
|
#else
|
|
buffersFifo.audioPushBuffer();
|
|
#endif
|
|
}
|
|
else {
|
|
// break the endless loop
|
|
break;
|
|
}
|
|
DEBUG_TIMER_START(debugTimerAudioConsume);
|
|
audioConsumeCurrentBuffer();
|
|
DEBUG_TIMER_STOP(debugTimerAudioConsume);
|
|
}
|
|
}
|
|
|
|
inline unsigned int getToneLength(uint16_t len)
|
|
{
|
|
unsigned int result = len; // default
|
|
if (g_eeGeneral.beepLength < 0) {
|
|
result /= (1-g_eeGeneral.beepLength);
|
|
}
|
|
else if (g_eeGeneral.beepLength > 0) {
|
|
result *= (1+g_eeGeneral.beepLength);
|
|
}
|
|
return result;
|
|
}
|
|
|
|
void AudioQueue::pause(uint16_t len)
|
|
{
|
|
playTone(0, 0, len);
|
|
}
|
|
|
|
bool AudioQueue::isPlaying(uint8_t id)
|
|
{
|
|
return normalContext.hasPromptId(id) ||
|
|
(isFunctionActive(FUNCTION_BACKGND_MUSIC) && backgroundContext.hasPromptId(id)) ||
|
|
fragmentsFifo.hasPromptId(id);
|
|
}
|
|
|
|
void AudioQueue::playTone(uint16_t freq, uint16_t len, uint16_t pause, uint8_t flags, int8_t freqIncr)
|
|
{
|
|
#if defined(SIMU) && !defined(SIMU_AUDIO)
|
|
return;
|
|
#endif
|
|
|
|
RTOS_LOCK_MUTEX(audioMutex);
|
|
|
|
freq = limit<uint16_t>(BEEP_MIN_FREQ, freq, BEEP_MAX_FREQ);
|
|
|
|
if (flags & PLAY_BACKGROUND) {
|
|
varioContext.setFragment(freq, len, pause, 0, 0, (flags & PLAY_NOW));
|
|
}
|
|
else {
|
|
// adjust frequency and length according to the user preferences
|
|
freq += g_eeGeneral.speakerPitch * 15;
|
|
len = getToneLength(len);
|
|
|
|
if (flags & PLAY_NOW) {
|
|
if (priorityContext.isFree()) {
|
|
priorityContext.clear();
|
|
priorityContext.setFragment(freq, len, pause, flags & 0x0f, freqIncr, false);
|
|
}
|
|
}
|
|
else {
|
|
fragmentsFifo.push(AudioFragment(freq, len, pause, flags & 0x0f, freqIncr, false));
|
|
}
|
|
}
|
|
|
|
RTOS_UNLOCK_MUTEX(audioMutex);
|
|
}
|
|
|
|
#if defined(SDCARD)
|
|
void AudioQueue::playFile(const char * filename, uint8_t flags, uint8_t id)
|
|
{
|
|
#if defined(SIMU)
|
|
TRACE("playFile(\"%s\", flags=%x, id=%d)", filename, flags, id);
|
|
if (strlen(filename) > AUDIO_FILENAME_MAXLEN) {
|
|
TRACE("file name too long! maximum length is %d characters", AUDIO_FILENAME_MAXLEN);
|
|
return;
|
|
}
|
|
#if !defined(SIMU_AUDIO)
|
|
return;
|
|
#endif
|
|
#endif
|
|
|
|
if (!sdMounted())
|
|
return;
|
|
|
|
if (g_eeGeneral.beepMode == e_mode_quiet)
|
|
return;
|
|
|
|
if (strlen(filename) > AUDIO_FILENAME_MAXLEN) {
|
|
POPUP_WARNING(STR_PATH_TOO_LONG);
|
|
return;
|
|
}
|
|
|
|
RTOS_LOCK_MUTEX(audioMutex);
|
|
|
|
if (flags & PLAY_BACKGROUND) {
|
|
backgroundContext.clear();
|
|
backgroundContext.setFragment(filename, 0, id);
|
|
}
|
|
else {
|
|
fragmentsFifo.push(AudioFragment(filename, flags & 0x0f, id));
|
|
}
|
|
|
|
RTOS_UNLOCK_MUTEX(audioMutex);
|
|
}
|
|
|
|
void AudioQueue::stopPlay(uint8_t id)
|
|
{
|
|
#if defined(SIMU)
|
|
TRACE("stopPlay(id=%d)", id);
|
|
#endif
|
|
|
|
#if defined(SIMU) && !defined(SIMU_AUDIO)
|
|
return;
|
|
#endif
|
|
|
|
RTOS_LOCK_MUTEX(audioMutex);
|
|
|
|
fragmentsFifo.removePromptById(id);
|
|
backgroundContext.stop(id);
|
|
|
|
RTOS_UNLOCK_MUTEX(audioMutex);
|
|
}
|
|
|
|
void AudioQueue::stopSD()
|
|
{
|
|
sdAvailableSystemAudioFiles.reset();
|
|
stopAll();
|
|
playTone(0, 0, 100, PLAY_NOW); // insert a 100ms pause
|
|
}
|
|
|
|
#endif
|
|
|
|
void AudioQueue::stopAll()
|
|
{
|
|
flush();
|
|
RTOS_LOCK_MUTEX(audioMutex);
|
|
priorityContext.clear();
|
|
normalContext.clear();
|
|
RTOS_UNLOCK_MUTEX(audioMutex);
|
|
}
|
|
|
|
void AudioQueue::flush()
|
|
{
|
|
RTOS_LOCK_MUTEX(audioMutex);
|
|
fragmentsFifo.clear();
|
|
varioContext.clear();
|
|
backgroundContext.clear();
|
|
RTOS_UNLOCK_MUTEX(audioMutex);
|
|
}
|
|
|
|
void audioPlay(unsigned int index, uint8_t id)
|
|
{
|
|
if (g_eeGeneral.beepMode >= -1) {
|
|
char filename[AUDIO_FILENAME_MAXLEN+1];
|
|
if (isAudioFileReferenced(index, filename)) {
|
|
audioQueue.playFile(filename, 0, id);
|
|
}
|
|
}
|
|
}
|
|
|
|
void audioKeyPress()
|
|
{
|
|
if (g_eeGeneral.beepMode == e_mode_all) {
|
|
audioQueue.playTone(BEEP_DEFAULT_FREQ, 40, 20, PLAY_NOW);
|
|
}
|
|
#if defined(HAPTIC)
|
|
if (g_eeGeneral.hapticMode == e_mode_all) {
|
|
haptic.play(5, 0, PLAY_NOW);
|
|
}
|
|
#endif
|
|
}
|
|
|
|
void audioKeyError()
|
|
{
|
|
if (g_eeGeneral.beepMode >= e_mode_nokeys) {
|
|
audioQueue.playTone(BEEP_DEFAULT_FREQ, 160, 20, PLAY_NOW);
|
|
}
|
|
|
|
#if defined(HAPTIC)
|
|
if (g_eeGeneral.hapticMode >= e_mode_nokeys) {
|
|
haptic.play(15, 3, PLAY_NOW);
|
|
}
|
|
#endif
|
|
}
|
|
|
|
void audioTrimPress(int value)
|
|
{
|
|
if (g_eeGeneral.beepMode >= e_mode_nokeys) {
|
|
value = limit(TRIM_MIN, value, TRIM_MAX) * 8 + 120*16;
|
|
audioQueue.playTone(value, 40, 20, PLAY_NOW);
|
|
}
|
|
}
|
|
|
|
void audioTimerCountdown(uint8_t timer, int value)
|
|
{
|
|
if (g_model.timers[timer].countdownBeep == COUNTDOWN_VOICE) {
|
|
if (value >= 0 && value <= TIMER_COUNTDOWN_START(timer)) {
|
|
playNumber(value, 0, 0, 0);
|
|
}
|
|
else if (value == 30 || value == 20) {
|
|
playDuration(value, 0, 0);
|
|
}
|
|
}
|
|
else if (g_model.timers[timer].countdownBeep == COUNTDOWN_BEEPS) {
|
|
if (value == 0) {
|
|
audioQueue.playTone(BEEP_DEFAULT_FREQ + 150, 300, 20, PLAY_NOW);
|
|
}
|
|
else if (value > 0 && value <= TIMER_COUNTDOWN_START(timer)) {
|
|
audioQueue.playTone(BEEP_DEFAULT_FREQ + 150, 100, 20, PLAY_NOW);
|
|
}
|
|
else if (value == 30) {
|
|
audioQueue.playTone(BEEP_DEFAULT_FREQ + 150, 120, 20, PLAY_REPEAT(2));
|
|
}
|
|
else if (value == 20) {
|
|
audioQueue.playTone(BEEP_DEFAULT_FREQ + 150, 120, 20, PLAY_REPEAT(1));
|
|
}
|
|
else if (value == 10) {
|
|
audioQueue.playTone(BEEP_DEFAULT_FREQ + 150, 120, 20, PLAY_NOW);
|
|
}
|
|
}
|
|
#if defined(HAPTIC)
|
|
else if (g_model.timers[timer].countdownBeep == COUNTDOWN_HAPTIC) {
|
|
if (value == 0) {
|
|
haptic.play(15, 3, PLAY_NOW);
|
|
}
|
|
else if (value > 0 && value <= TIMER_COUNTDOWN_START(timer)) {
|
|
haptic.play(10, 0, PLAY_NOW);
|
|
}
|
|
else if (value == 30) {
|
|
haptic.play(10, 3, PLAY_REPEAT(2) | PLAY_NOW);
|
|
}
|
|
else if (value == 20) {
|
|
haptic.play(10, 3, PLAY_REPEAT(1) | PLAY_NOW);
|
|
}
|
|
else if (value == 10) {
|
|
haptic.play(10, 3, PLAY_NOW);
|
|
}
|
|
}
|
|
#endif
|
|
}
|
|
|
|
void audioEvent(unsigned int index)
|
|
{
|
|
if (index == AU_NONE)
|
|
return;
|
|
|
|
#if defined(HAPTIC)
|
|
haptic.event(index); // do this before audio to help sync timings
|
|
#endif
|
|
|
|
if (index <= AU_ERROR) {
|
|
if (g_eeGeneral.alarmsFlash) {
|
|
flashCounter = FLASH_DURATION;
|
|
}
|
|
}
|
|
|
|
if (g_eeGeneral.beepMode >= e_mode_nokeys || (g_eeGeneral.beepMode >= e_mode_alarms && index <= AU_ERROR)) {
|
|
#if defined(SDCARD)
|
|
char filename[AUDIO_FILENAME_MAXLEN + 1];
|
|
if (index < AU_SPECIAL_SOUND_FIRST && isAudioFileReferenced(index, filename)) {
|
|
audioQueue.stopPlay(ID_PLAY_PROMPT_BASE + index);
|
|
audioQueue.playFile(filename, 0, ID_PLAY_PROMPT_BASE + index);
|
|
return;
|
|
}
|
|
#endif
|
|
switch (index) {
|
|
case AU_INACTIVITY:
|
|
audioQueue.playTone(2250, 80, 20, PLAY_REPEAT(2));
|
|
break;
|
|
case AU_TX_BATTERY_LOW:
|
|
#if defined(PCBSKY9X)
|
|
case AU_TX_MAH_HIGH:
|
|
case AU_TX_TEMP_HIGH:
|
|
#endif
|
|
audioQueue.playTone(1950, 160, 20, PLAY_REPEAT(2), 1);
|
|
audioQueue.playTone(2550, 160, 20, PLAY_REPEAT(2), -1);
|
|
break;
|
|
case AU_THROTTLE_ALERT:
|
|
case AU_SWITCH_ALERT:
|
|
case AU_ERROR:
|
|
audioQueue.playTone(BEEP_DEFAULT_FREQ, 200, 20, PLAY_NOW);
|
|
break;
|
|
case AU_TRIM_MIDDLE:
|
|
audioQueue.playTone(120*16, 80, 20, PLAY_NOW);
|
|
break;
|
|
case AU_TRIM_MIN:
|
|
audioQueue.playTone(TRIM_MIN*8 + 120*16, 80, 20, PLAY_NOW);
|
|
break;
|
|
case AU_TRIM_MAX:
|
|
audioQueue.playTone(TRIM_MAX*8 + 120*16, 80, 20, PLAY_NOW);
|
|
break;
|
|
case AU_WARNING1:
|
|
audioQueue.playTone(BEEP_DEFAULT_FREQ, 80, 20, PLAY_NOW);
|
|
break;
|
|
case AU_WARNING2:
|
|
audioQueue.playTone(BEEP_DEFAULT_FREQ, 160, 20, PLAY_NOW);
|
|
break;
|
|
case AU_WARNING3:
|
|
audioQueue.playTone(BEEP_DEFAULT_FREQ, 200, 20, PLAY_NOW);
|
|
break;
|
|
// TODO remove all these ones
|
|
case AU_STICK1_MIDDLE:
|
|
case AU_STICK2_MIDDLE:
|
|
case AU_STICK3_MIDDLE:
|
|
case AU_STICK4_MIDDLE:
|
|
case AU_POT1_MIDDLE:
|
|
case AU_POT2_MIDDLE:
|
|
#if defined(PCBX9E)
|
|
case AU_POT3_MIDDLE:
|
|
case AU_POT4_MIDDLE:
|
|
#endif
|
|
#if defined(PCBFRSKY)
|
|
case AU_SLIDER1_MIDDLE:
|
|
case AU_SLIDER2_MIDDLE:
|
|
#if defined(PCBX9E)
|
|
case AU_SLIDER3_MIDDLE:
|
|
case AU_SLIDER4_MIDDLE:
|
|
#endif
|
|
#else
|
|
case AU_POT3_MIDDLE:
|
|
#endif
|
|
audioQueue.playTone(BEEP_DEFAULT_FREQ + 1500, 80, 20, PLAY_NOW);
|
|
break;
|
|
case AU_MIX_WARNING_1:
|
|
audioQueue.playTone(BEEP_DEFAULT_FREQ + 1440, 48, 32);
|
|
break;
|
|
case AU_MIX_WARNING_2:
|
|
audioQueue.playTone(BEEP_DEFAULT_FREQ + 1560, 48, 32, PLAY_REPEAT(1));
|
|
break;
|
|
case AU_MIX_WARNING_3:
|
|
audioQueue.playTone(BEEP_DEFAULT_FREQ + 1680, 48, 32, PLAY_REPEAT(2));
|
|
break;
|
|
case AU_TIMER1_ELAPSED:
|
|
case AU_TIMER2_ELAPSED:
|
|
case AU_TIMER3_ELAPSED:
|
|
audioQueue.playTone(BEEP_DEFAULT_FREQ + 150, 300, 20, PLAY_NOW);
|
|
break;
|
|
case AU_RSSI_ORANGE:
|
|
audioQueue.playTone(BEEP_DEFAULT_FREQ + 1500, 800, 20, PLAY_NOW);
|
|
break;
|
|
case AU_RSSI_RED:
|
|
audioQueue.playTone(BEEP_DEFAULT_FREQ + 1800, 800, 20, PLAY_REPEAT(1) | PLAY_NOW);
|
|
break;
|
|
case AU_RAS_RED:
|
|
audioQueue.playTone(450, 160, 40, PLAY_REPEAT(2), 1);
|
|
break;
|
|
case AU_SPECIAL_SOUND_BEEP1:
|
|
audioQueue.playTone(BEEP_DEFAULT_FREQ, 60, 20);
|
|
break;
|
|
case AU_SPECIAL_SOUND_BEEP2:
|
|
audioQueue.playTone(BEEP_DEFAULT_FREQ, 120, 20);
|
|
break;
|
|
case AU_SPECIAL_SOUND_BEEP3:
|
|
audioQueue.playTone(BEEP_DEFAULT_FREQ, 200, 20);
|
|
break;
|
|
case AU_SPECIAL_SOUND_WARN1:
|
|
audioQueue.playTone(BEEP_DEFAULT_FREQ + 600, 120, 40, PLAY_REPEAT(2));
|
|
break;
|
|
case AU_SPECIAL_SOUND_WARN2:
|
|
audioQueue.playTone(BEEP_DEFAULT_FREQ + 900, 120, 40, PLAY_REPEAT(2));
|
|
break;
|
|
case AU_SPECIAL_SOUND_CHEEP:
|
|
audioQueue.playTone(BEEP_DEFAULT_FREQ + 900, 80, 20, PLAY_REPEAT(2), 2);
|
|
break;
|
|
case AU_SPECIAL_SOUND_RING:
|
|
audioQueue.playTone(BEEP_DEFAULT_FREQ + 750, 40, 20, PLAY_REPEAT(10));
|
|
audioQueue.playTone(BEEP_DEFAULT_FREQ + 750, 40, 80, PLAY_REPEAT(1));
|
|
audioQueue.playTone(BEEP_DEFAULT_FREQ + 750, 40, 20, PLAY_REPEAT(10));
|
|
break;
|
|
case AU_SPECIAL_SOUND_SCIFI:
|
|
audioQueue.playTone(2550, 80, 20, PLAY_REPEAT(2), -1);
|
|
audioQueue.playTone(1950, 80, 20, PLAY_REPEAT(2), 1);
|
|
audioQueue.playTone(2250, 80, 20, 0);
|
|
break;
|
|
case AU_SPECIAL_SOUND_ROBOT:
|
|
audioQueue.playTone(2250, 40, 20, PLAY_REPEAT(1));
|
|
audioQueue.playTone(1650, 120, 20, PLAY_REPEAT(1));
|
|
audioQueue.playTone(2550, 120, 20, PLAY_REPEAT(1));
|
|
break;
|
|
case AU_SPECIAL_SOUND_CHIRP:
|
|
audioQueue.playTone(BEEP_DEFAULT_FREQ + 1200, 40, 20, PLAY_REPEAT(2));
|
|
audioQueue.playTone(BEEP_DEFAULT_FREQ + 1620, 40, 20, PLAY_REPEAT(3));
|
|
break;
|
|
case AU_SPECIAL_SOUND_TADA:
|
|
audioQueue.playTone(1650, 80, 40);
|
|
audioQueue.playTone(2850, 80, 40);
|
|
audioQueue.playTone(3450, 64, 36, PLAY_REPEAT(2));
|
|
break;
|
|
case AU_SPECIAL_SOUND_CRICKET:
|
|
audioQueue.playTone(2550, 40, 80, PLAY_REPEAT(3));
|
|
audioQueue.playTone(2550, 40, 160, PLAY_REPEAT(1));
|
|
audioQueue.playTone(2550, 40, 80, PLAY_REPEAT(3));
|
|
break;
|
|
case AU_SPECIAL_SOUND_SIREN:
|
|
audioQueue.playTone(450, 160, 40, PLAY_REPEAT(2), 2);
|
|
break;
|
|
case AU_SPECIAL_SOUND_ALARMC:
|
|
audioQueue.playTone(1650, 32, 68, PLAY_REPEAT(2));
|
|
audioQueue.playTone(2250, 64, 156, PLAY_REPEAT(1));
|
|
audioQueue.playTone(1650, 64, 76, PLAY_REPEAT(2));
|
|
audioQueue.playTone(2250, 32, 168, PLAY_REPEAT(1));
|
|
break;
|
|
case AU_SPECIAL_SOUND_RATATA:
|
|
audioQueue.playTone(BEEP_DEFAULT_FREQ + 1500, 40, 80, PLAY_REPEAT(10));
|
|
break;
|
|
case AU_SPECIAL_SOUND_TICK:
|
|
audioQueue.playTone(BEEP_DEFAULT_FREQ + 1500, 40, 400, PLAY_REPEAT(2));
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
#if defined(SDCARD)
|
|
void pushUnit(uint8_t unit, uint8_t idx, uint8_t id)
|
|
{
|
|
if (unit < DIM(unitsFilenames)) {
|
|
char path[AUDIO_FILENAME_MAXLEN+1];
|
|
char * tmp = strAppendSystemAudioPath(path);
|
|
tmp = strAppendStringWithIndex(tmp, unitsFilenames[unit], idx);
|
|
strcpy(tmp, SOUNDS_EXT);
|
|
audioQueue.playFile(path, 0, id);
|
|
}
|
|
else {
|
|
TRACE("pushUnit: out of bounds unit : %d", unit); // We should never get here, but given the nature of TTS files, this prevent segfault in case of bug there.
|
|
}
|
|
}
|
|
#endif
|
|
|
|
void pushPrompt(uint16_t prompt, uint8_t id)
|
|
{
|
|
#if defined(SDCARD)
|
|
char filename[AUDIO_FILENAME_MAXLEN+1];
|
|
char * str = strAppendSystemAudioPath(filename);
|
|
strcpy(str, "0000" SOUNDS_EXT);
|
|
for (int8_t i=3; i>=0; i--) {
|
|
str[i] = '0' + (prompt%10);
|
|
prompt /= 10;
|
|
}
|
|
audioQueue.playFile(filename, 0, id);
|
|
#endif
|
|
}
|
|
|
|
void onKeyPress()
|
|
{
|
|
audioKeyPress();
|
|
}
|
|
|
|
void onKeyError()
|
|
{
|
|
audioKeyError();
|
|
}
|