feat: Support for Flysky ST16 (#6071)

Co-authored-by: raphaelcoeffic <1050031+raphaelcoeffic@users.noreply.github.com> Co-authored-by: Peter Feerick <peter.feerick@gmail.com> Co-authored-by: philmoz <phil.a.mitchell@gmail.com> Co-authored-by: Malte Langermann <malte@langermann.net>
2025-04-16 11:18:21 +10:00
parent 94965c1d09
commit f82c3dea8c
58 changed files with 8369 additions and 25 deletions
@@ -0,0 +1,81 @@
+/*
+ * 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 "bsp_io.h"
+#include "stm32_hal_ll.h"
+#include "stm32_gpio_driver.h"
+#include "stm32_i2c_driver.h"
+
+#include "hal.h"
+#include "delays_driver.h"
+#include "keys.h"
+
+#include "stm32_keys.inc"
+
+void keysInit() { _init_keys(); }
+
+uint32_t readKeys() { return _read_keys(); }
+
+/* The output bit-order has to be:
+   0  LHL  TR3L (Left equals down)
+   1  LHR  TR3R
+   2  LVD  TR1D
+   3  LVU  TR1U
+   4  RVD  TR2D
+   5  RVU  TR2U
+   6  RHL  TR4L
+   7  RHR  TR4R
+*/
+
+enum PhysicalTrims {
+  TR3L = 0,
+  TR3R,
+  TR1D = 2,
+  TR1U,
+  TR2D = 4,
+  TR2U,
+  TR4L = 6,
+  TR4R
+};
+
+uint32_t readTrims()
+{
+  uint32_t result = 0;
+  uint16_t keys = bsp_input_get();
+  
+#define _TRIM(t) \
+  if ((keys & BSP_##t) == 0) result |= 1 << t;
+
+  _TRIM(TR1U);
+  _TRIM(TR1D);
+  _TRIM(TR3L);
+  _TRIM(TR3R);
+  _TRIM(TR2U);
+  _TRIM(TR2D);
+  _TRIM(TR4L);
+  _TRIM(TR4R);
+
+#undef _TRIM
+
+  return result;
+}