Superminaren/MMDVM
1
0
Fork 0
mirror of https://github.com/g4klx/MMDVM.git synced 2026-10-22 18:45:01 +02:00
Code Issues Packages Projects Releases Wiki Activity

Add the timeout tones.

Browse Source
This commit is contained in:
Jonathan Naylor
2020-04-15 18:38:39 +01:00
parent a9a985182f
commit ebd87584da
4 changed files with 95 additions and 6 deletions
Download Patch File Download Diff File Expand all files Collapse all files
FMTimeout.cpp
+30 -1
View File
@@ -20,9 +20,17 @@
#include "Globals.h"
#include "FMTimeout.h"
// 400 Hz sine wave at 24000 Hz sample rate
const q15_t BUSY_AUDIO[] = {0, 3426, 6813, 10126, 13328, 16384, 19261, 21926, 24351, 26510, 28378, 29935, 31164, 32052, 32588, 32768, 32588, 32052, 31164, 29935, 28378, 26510, 24351,
21926, 19261, 16384, 13328, 10126, 6813, 3425, 0, -3425, -6813, -10126, -13328, -16384, -19261, -21926, -24351, -26510, -28378, -29935, -31164, -32052,
-32588, -32768, -32588, -32052, -31164, -29935, -28378, -26510, -24351, -21926, -19261, -16384, -13328, -10126, -6813, -3425};
const uint8_t BUSY_AUDIO_LEN = 60U;
CFMTimeout::CFMTimeout() :
m_level(128 * 128),
m_running(false)
m_running(false),
m_pos(0U),
m_n(0U)
{
}
@@ -33,11 +41,32 @@ void CFMTimeout::setParams(uint8_t level)
void CFMTimeout::getAudio(q15_t* samples, uint8_t length)
{
if (!m_running)
return;
for (uint8_t i = 0U; i < length; i++) {
if (m_pos > 12000U) {
q31_t sample = BUSY_AUDIO[m_n] * m_level;
samples[i] = q15_t(__SSAT((sample >> 15), 16));
m_n++;
if (m_n >= BUSY_AUDIO_LEN)
m_n = 0U;
} else {
samples[i] = 0;
}
m_pos++;
if (m_pos >= 24000U)
m_pos = 0U;
}
}
void CFMTimeout::start()
{
m_running = true;
m_pos = 0U;
m_n = 0U;
}
void CFMTimeout::stop()