124 lines
3.0 KiB
C++
124 lines
3.0 KiB
C++
/*
|
|
* Copyright (C) EdgeTX
|
|
*
|
|
* Based on code named
|
|
* opentx - https://github.com/opentx/opentx
|
|
* 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 "hal/switch_driver.h"
|
|
#include "stm32_switch_driver.h"
|
|
//#include "stm32_gpio_driver.h"
|
|
|
|
#include "definitions.h"
|
|
#include "opentx_constants.h"
|
|
#include "myeeprom.h"
|
|
#include "hal/adc_driver.h"
|
|
|
|
#include <stdlib.h>
|
|
|
|
#define __weak __attribute__((weak))
|
|
|
|
static const stm32_switch_t _switch_defs[] = {
|
|
/* {
|
|
"S1A",
|
|
nullptr, 0,
|
|
nullptr, 0,
|
|
SWITCH_HW_2POS, 0
|
|
},
|
|
{
|
|
"S1B",
|
|
nullptr, 0,
|
|
nullptr, 0,
|
|
SWITCH_HW_2POS, 0
|
|
},*/
|
|
{
|
|
"S2",
|
|
nullptr, 0,
|
|
nullptr, 0,
|
|
SWITCH_HW_2POS, 0
|
|
},
|
|
{
|
|
"S3",
|
|
nullptr, 0,
|
|
nullptr, 0,
|
|
SWITCH_HW_2POS, 0
|
|
}
|
|
};
|
|
|
|
constexpr uint8_t n_switches = 2;
|
|
constexpr uint8_t n_fct_switches = 0;
|
|
|
|
constexpr swconfig_t _switch_default_config = (swconfig_t)0
|
|
| ((swconfig_t)SWITCH_2POS << (0 * SW_CFG_BITS))
|
|
| ((swconfig_t)SWITCH_2POS << (1 * SW_CFG_BITS))
|
|
/* | ((swconfig_t)SWITCH_2POS << (2 * SW_CFG_BITS))
|
|
| ((swconfig_t)SWITCH_2POS << (3 * SW_CFG_BITS))*/
|
|
;
|
|
|
|
const switch_display_pos_t _switch_display[] = {
|
|
{ 0, 0 },
|
|
{ 0, 0 },
|
|
/* { 0, 0 },
|
|
{ 0, 0 },*/
|
|
};
|
|
|
|
SwitchHwPos boardSwitchGetPosition(uint8_t cat, uint8_t idx)
|
|
{
|
|
if (idx <= 1) {
|
|
// uint16_t swVal = getAnalogValue(4);
|
|
uint16_t swVal = getAnalogValue(5);
|
|
if (idx == 0 && (swVal < 512 || (swVal >= 1536 && swVal < 2560))) {
|
|
return SWITCH_HW_DOWN;
|
|
}
|
|
if (idx == 1 && (swVal >= 3584 || (swVal >= 1536 && swVal < 2560))) {
|
|
return SWITCH_HW_DOWN;
|
|
}
|
|
} /*else if (idx <= 3) {
|
|
uint16_t swVal = getAnalogValue(5);
|
|
if (idx == 3 && (swVal < 512 || (swVal >= 1536 && swVal < 2560))) {
|
|
return SWITCH_HW_DOWN;
|
|
}
|
|
if (idx == 2 && (swVal >= 3584 || (swVal >= 1536 && swVal < 2560))) {
|
|
return SWITCH_HW_DOWN;
|
|
}
|
|
}*/
|
|
return SWITCH_HW_UP;
|
|
}
|
|
|
|
const char* boardSwitchGetName(uint8_t cat, uint8_t idx)
|
|
{
|
|
return _switch_defs[idx].name;
|
|
}
|
|
|
|
SwitchHwType boardSwitchGetType(uint8_t cat, uint8_t idx)
|
|
{
|
|
return _switch_defs[idx].type;
|
|
}
|
|
|
|
uint8_t boardGetMaxSwitches() { return n_switches; }
|
|
uint8_t boardGetMaxFctSwitches() { return n_fct_switches; }
|
|
|
|
swconfig_t boardSwitchGetDefaultConfig() { return _switch_default_config; }
|
|
|
|
switch_display_pos_t switchGetDisplayPosition(uint8_t idx)
|
|
{
|
|
// TODO: find a solution for FLEX switches so they can be displayed on main view
|
|
if (idx >= DIM(_switch_display)) return {0, 0};
|
|
|
|
return _switch_display[idx];
|
|
}
|