127 lines
2.6 KiB
C++
127 lines
2.6 KiB
C++
#include "hal/gpio.h"
|
|
#include "stm32_gpio.h"
|
|
#include "trainer_driver.h"
|
|
|
|
#include "hal.h"
|
|
#include "edgetx.h"
|
|
|
|
static void initSpeakerEnable()
|
|
{
|
|
gpio_init(AUDIO_SPEAKER_ENABLE_GPIO, GPIO_OUT, GPIO_PIN_SPEED_LOW);
|
|
}
|
|
|
|
static void enableSpeaker()
|
|
{
|
|
gpio_set(AUDIO_SPEAKER_ENABLE_GPIO);
|
|
}
|
|
|
|
static void disableSpeaker()
|
|
{
|
|
gpio_clear(AUDIO_SPEAKER_ENABLE_GPIO);
|
|
}
|
|
|
|
static void initHeadphoneTrainerSwitch()
|
|
{
|
|
gpio_init(HEADPHONE_TRAINER_SWITCH_GPIO, GPIO_OUT, GPIO_PIN_SPEED_LOW);
|
|
}
|
|
|
|
static void enableHeadphone()
|
|
{
|
|
gpio_clear(HEADPHONE_TRAINER_SWITCH_GPIO);
|
|
}
|
|
|
|
static void enableTrainer()
|
|
{
|
|
gpio_set(HEADPHONE_TRAINER_SWITCH_GPIO);
|
|
}
|
|
|
|
static void initJackDetect(void)
|
|
{
|
|
gpio_init(JACK_DETECT_GPIO, GPIO_IN_PU, GPIO_PIN_SPEED_LOW);
|
|
}
|
|
|
|
static bool isJackPlugged()
|
|
{
|
|
// debounce
|
|
static bool debounced_state = 0;
|
|
static bool last_state = 0;
|
|
|
|
if (gpio_read(JACK_DETECT_GPIO)) {
|
|
if (!last_state) {
|
|
debounced_state = false;
|
|
}
|
|
last_state = false;
|
|
}
|
|
else {
|
|
if (last_state) {
|
|
debounced_state = true;
|
|
}
|
|
last_state = true;
|
|
}
|
|
return debounced_state;
|
|
}
|
|
|
|
enum JackState
|
|
{
|
|
SPEAKER_ACTIVE,
|
|
HEADPHONE_ACTIVE,
|
|
TRAINER_ACTIVE,
|
|
};
|
|
|
|
uint8_t jackState = SPEAKER_ACTIVE;
|
|
|
|
const char STR_JACK_HEADPHONE[] = "Headphone";
|
|
const char STR_JACK_TRAINER[] = "Trainer";
|
|
|
|
void onJackConnectMenu(const char* result)
|
|
{
|
|
if (result == STR_JACK_HEADPHONE) {
|
|
jackState = HEADPHONE_ACTIVE;
|
|
disableSpeaker();
|
|
enableHeadphone();
|
|
} else if (result == STR_JACK_TRAINER) {
|
|
jackState = TRAINER_ACTIVE;
|
|
enableTrainer();
|
|
}
|
|
}
|
|
|
|
void handleJackConnection()
|
|
{
|
|
if (jackState == SPEAKER_ACTIVE && isJackPlugged()) {
|
|
if (g_eeGeneral.jackMode == JACK_HEADPHONE_MODE) {
|
|
jackState = HEADPHONE_ACTIVE;
|
|
disableSpeaker();
|
|
enableHeadphone();
|
|
} else if (g_eeGeneral.jackMode == JACK_TRAINER_MODE) {
|
|
jackState = TRAINER_ACTIVE;
|
|
enableTrainer();
|
|
} else if (popupMenuItemsCount == 0) {
|
|
POPUP_MENU_START(onJackConnectMenu, 2, STR_JACK_HEADPHONE, STR_JACK_TRAINER);
|
|
}
|
|
} else if (jackState == SPEAKER_ACTIVE && !isJackPlugged() &&
|
|
popupMenuItemsCount > 0 && popupMenuHandler == onJackConnectMenu) {
|
|
popupMenuItemsCount = 0;
|
|
} else if (jackState != SPEAKER_ACTIVE && !isJackPlugged()) {
|
|
jackState = SPEAKER_ACTIVE;
|
|
enableSpeaker();
|
|
}
|
|
}
|
|
|
|
// defined __WEAK in boards/generic_stm32/trainer_driver.cpp
|
|
void board_trainer_init()
|
|
{
|
|
initJackDetect();
|
|
initSpeakerEnable();
|
|
enableSpeaker();
|
|
initHeadphoneTrainerSwitch();
|
|
|
|
trainer_init();
|
|
}
|
|
|
|
// defined __WEAK in boards/generic_stm32/trainer_driver.cpp
|
|
bool is_trainer_dsc_connected()
|
|
{
|
|
return jackState == TRAINER_ACTIVE;
|
|
}
|
|
|