Can enter bootloader with S2 + S3

2025-01-24 19:00:12 +01:00
parent 3a673cc0e5
commit 7dcb4b3d9a
5 changed files with 134 additions and 5 deletions
@@ -0,0 +1,122 @@
+/*
+ * 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/key_driver.h"
+
+#include "stm32_hal_ll.h"
+#include "stm32_gpio_driver.h"
+
+#include "hal.h"
+#include "delays_driver.h"
+#include "keys.h"
+
+#define BOOTLOADER_KEYS                 0x42
+
+void keysInit()
+{
+#if defined(BOOT)
+  LL_GPIO_InitTypeDef pinInit;
+  LL_GPIO_StructInit(&pinInit);
+  
+  pinInit.Pin = ADC_GPIO_PIN_SWB;
+  pinInit.Mode = LL_GPIO_MODE_ANALOG;
+  pinInit.Pull = LL_GPIO_PULL_NO;
+  stm32_gpio_enable_clock(ADC_GPIO_SWB);
+  LL_GPIO_Init(ADC_GPIO_SWB, &pinInit);
+
+  // Init ADC clock
+  uint32_t adc_idx = (((uint32_t) ADC_MAIN) - ADC1_BASE) / 0x100UL;
+  uint32_t adc_msk = RCC_APB2ENR_ADC1EN << adc_idx;
+  LL_APB2_GRP1_EnableClock(adc_msk);
+
+  // Init common to all ADCs
+  LL_ADC_CommonInitTypeDef commonInit;
+  LL_ADC_CommonStructInit(&commonInit);
+
+  commonInit.CommonClock = LL_ADC_CLOCK_SYNC_PCLK_DIV4;
+  LL_ADC_CommonInit(__LL_ADC_COMMON_INSTANCE(ADC_MAIN), &commonInit);
+
+  // ADC must be disabled for the functions used here
+  LL_ADC_Disable(ADC_MAIN);
+
+  LL_ADC_InitTypeDef adcInit;
+  LL_ADC_StructInit(&adcInit);
+  adcInit.SequencersScanMode = LL_ADC_SEQ_SCAN_DISABLE;
+  adcInit.DataAlignment = LL_ADC_DATA_ALIGN_RIGHT;
+  adcInit.Resolution = LL_ADC_RESOLUTION_12B;
+  LL_ADC_Init(ADC_MAIN, &adcInit);
+
+  LL_ADC_REG_InitTypeDef adcRegInit;
+  LL_ADC_REG_StructInit(&adcRegInit);
+  adcRegInit.TriggerSource = LL_ADC_REG_TRIG_SOFTWARE;
+  adcRegInit.ContinuousMode = LL_ADC_REG_CONV_SINGLE;
+  LL_ADC_REG_Init(ADC_MAIN, &adcRegInit);
+
+  // Enable ADC
+  LL_ADC_Enable(ADC_MAIN);
+#endif
+}
+
+#if defined(BOOT)
+uint16_t _adcRead()
+{
+  // Configure ADC channel
+  LL_ADC_REG_SetSequencerRanks(ADC_MAIN, LL_ADC_REG_RANK_1, ADC_CHANNEL_SWB);
+  LL_ADC_SetChannelSamplingTime(ADC_MAIN, ADC_CHANNEL_SWB, LL_ADC_SAMPLINGTIME_3CYCLES);
+
+  // Start ADC conversion
+  LL_ADC_REG_StartConversionSWStart(ADC_MAIN);
+
+  // Wait until ADC conversion is complete
+  uint32_t timeout = 0;
+  while (!LL_ADC_IsActiveFlag_EOCS(ADC_MAIN));
+
+  // Read ADC converted value
+  return LL_ADC_REG_ReadConversionData12(ADC_MAIN);
+}
+#endif
+
+uint32_t readKeys()
+{
+  uint32_t result = 0;
+
+#if defined(BOOT)
+  uint16_t value = _adcRead();
+  if (value >= 3584)
+    result |= 1 << KEY_ENTER;
+  else if (value < 512)
+    result |= 1 << KEY_EXIT;
+#endif
+
+  return result;
+}
+
+uint32_t readTrims()
+{
+  uint32_t result = 0;
+
+#if defined(BOOT)
+  uint16_t value = _adcRead();
+  if (value >= 1536 && value < 2560)
+    result = BOOTLOADER_KEYS;
+#endif
+  return result;
+}