161 lines
5.5 KiB
C
161 lines
5.5 KiB
C
/***************************************************************************
|
|
* Copyright (C) 2021 - 2023 by Federico Amedeo Izzo IU2NUO, *
|
|
* Niccolò Izzo IU2KIN *
|
|
* Frederik Saraci IU2NRO *
|
|
* Silvano Seva IU2KWO *
|
|
* *
|
|
* 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 <interfaces/delays.h>
|
|
#include <interfaces/audio.h>
|
|
#include <interfaces/radio.h>
|
|
#include <peripherals/gpio.h>
|
|
#include <hwconfig.h>
|
|
|
|
#define PATH(x,y) ((x << 4) | y)
|
|
|
|
static const uint8_t pathCompatibilityMatrix[9][9] =
|
|
{
|
|
// MIC-SPK MIC-RTX MIC-MCU RTX-SPK RTX-RTX RTX-MCU MCU-SPK MCU-RTX MCU-MCU
|
|
{ 0 , 0 , 0 , 1 , 0 , 1 , 1 , 0 , 1 }, // MIC-RTX
|
|
{ 0 , 0 , 0 , 0 , 1 , 1 , 0 , 0 , 1 }, // MIC-SPK
|
|
{ 0 , 0 , 0 , 1 , 1 , 0 , 1 , 1 , 0 }, // MIC-MCU
|
|
{ 0 , 1 , 1 , 0 , 0 , 0 , 0 , 1 , 1 }, // RTX-SPK
|
|
{ 1 , 0 , 1 , 0 , 0 , 0 , 1 , 0 , 1 }, // RTX-RTX
|
|
{ 1 , 1 , 0 , 0 , 0 , 0 , 1 , 1 , 0 }, // RTX-MCU
|
|
{ 0 , 1 , 1 , 0 , 1 , 1 , 0 , 0 , 0 }, // MCU-SPK
|
|
{ 0 , 0 , 1 , 1 , 0 , 1 , 0 , 0 , 0 }, // MCU-RTX
|
|
{ 1 , 1 , 0 , 1 , 1 , 0 , 0 , 0 , 0 } // MCU-MCU
|
|
};
|
|
|
|
|
|
void audio_init()
|
|
{
|
|
gpio_setMode(SPK_MUTE, OUTPUT);
|
|
#ifndef PLATFORM_MD9600
|
|
gpio_setMode(AUDIO_AMP_EN, OUTPUT);
|
|
#ifndef MDx_ENABLE_SWD
|
|
gpio_setMode(MIC_PWR, OUTPUT);
|
|
#endif
|
|
#endif
|
|
|
|
gpio_setMode(BEEP_OUT, INPUT);
|
|
|
|
gpio_setPin(SPK_MUTE); // Speaker muted
|
|
#ifndef PLATFORM_MD9600
|
|
gpio_clearPin(AUDIO_AMP_EN); // Audio PA off
|
|
#ifndef MDx_ENABLE_SWD
|
|
gpio_clearPin(MIC_PWR); // Mic preamp. off
|
|
#endif
|
|
#endif
|
|
}
|
|
|
|
void audio_terminate()
|
|
{
|
|
gpio_setPin(SPK_MUTE); // Speaker muted
|
|
#ifndef PLATFORM_MD9600
|
|
gpio_clearPin(AUDIO_AMP_EN); // Audio PA off
|
|
#ifndef MDx_ENABLE_SWD
|
|
gpio_clearPin(MIC_PWR); // Mic preamp. off
|
|
#endif
|
|
#endif
|
|
}
|
|
|
|
void audio_connect(const enum AudioSource source, const enum AudioSink sink)
|
|
{
|
|
uint32_t path = PATH(source, sink);
|
|
|
|
switch(path)
|
|
{
|
|
case PATH(SOURCE_MIC, SINK_SPK):
|
|
case PATH(SOURCE_MIC, SINK_RTX):
|
|
case PATH(SOURCE_MIC, SINK_MCU):
|
|
#if !defined(PLATFORM_MD9600) && !defined(MDx_ENABLE_SWD)
|
|
gpio_setPin(MIC_PWR);
|
|
#endif
|
|
break;
|
|
|
|
case PATH(SOURCE_RTX, SINK_SPK):
|
|
radio_enableAfOutput();
|
|
break;
|
|
|
|
case PATH(SOURCE_MCU, SINK_SPK):
|
|
case PATH(SOURCE_MCU, SINK_RTX):
|
|
gpio_setMode(BEEP_OUT, ALTERNATE);
|
|
break;
|
|
|
|
default:
|
|
break;
|
|
}
|
|
|
|
if(sink == SINK_SPK)
|
|
{
|
|
// Anti-pop: unmute speaker after 10ms from amp. power on
|
|
#ifndef PLATFORM_MD9600
|
|
gpio_setPin(AUDIO_AMP_EN);
|
|
#endif
|
|
sleepFor(0, 10);
|
|
gpio_clearPin(SPK_MUTE);
|
|
}
|
|
}
|
|
|
|
void audio_disconnect(const enum AudioSource source, const enum AudioSink sink)
|
|
{
|
|
uint32_t path = PATH(source, sink);
|
|
|
|
if(sink == SINK_SPK)
|
|
{
|
|
gpio_setPin(SPK_MUTE);
|
|
#ifndef PLATFORM_MD9600
|
|
gpio_clearPin(AUDIO_AMP_EN);
|
|
#endif
|
|
}
|
|
|
|
switch(path)
|
|
{
|
|
case PATH(SOURCE_MIC, SINK_SPK):
|
|
case PATH(SOURCE_MIC, SINK_RTX):
|
|
case PATH(SOURCE_MIC, SINK_MCU):
|
|
#if !defined(PLATFORM_MD9600) && !defined(MDx_ENABLE_SWD)
|
|
gpio_clearPin(MIC_PWR);
|
|
#endif
|
|
break;
|
|
|
|
case PATH(SOURCE_RTX, SINK_SPK):
|
|
radio_disableAfOutput();
|
|
break;
|
|
|
|
case PATH(SOURCE_MCU, SINK_SPK):
|
|
case PATH(SOURCE_MCU, SINK_RTX):
|
|
gpio_setMode(BEEP_OUT, INPUT); // Set output to Hi-Z
|
|
break;
|
|
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
|
|
bool audio_checkPathCompatibility(const enum AudioSource p1Source,
|
|
const enum AudioSink p1Sink,
|
|
const enum AudioSource p2Source,
|
|
const enum AudioSink p2Sink)
|
|
|
|
{
|
|
uint8_t p1Index = (p1Source * 3) + p1Sink;
|
|
uint8_t p2Index = (p2Source * 3) + p2Sink;
|
|
|
|
return pathCompatibilityMatrix[p1Index][p2Index] == 1;
|
|
}
|