Horus : very draft internal PXX2 module

2019-04-27 11:50:55 +02:00
parent 2d67629e17
commit bf10c912bc
8 changed files with 696 additions and 89 deletions
@@ -19,3 +19,138 @@
 */

 #include <opentx.h>
+
+#define RECEIVER_OPTIONS_2ND_COLUMN 80
+
+extern uint8_t g_moduleIdx;
+
+void onRxOptionsUpdateConfirm(const char * result)
+{
+  if (result == STR_OK) {
+    reusableBuffer.hardwareAndSettings.receiverSettings.state = PXX2_SETTINGS_WRITE;
+    reusableBuffer.hardwareAndSettings.receiverSettings.dirty = 2;
+    reusableBuffer.hardwareAndSettings.receiverSettings.timeout = 0;
+    moduleState[g_moduleIdx].mode = MODULE_MODE_RECEIVER_SETTINGS;
+  }
+  else {
+    popMenu();
+  }
+}
+
+enum {
+  ITEM_RECEIVER_TELEMETRY,
+  ITEM_RECEIVER_PWM_RATE,
+  ITEM_RECEIVER_PINMAP_FIRST
+};
+
+bool menuModelReceiverOptions(event_t event)
+{
+  const int lim = (g_model.extendedLimits ? (512 * LIMIT_EXT_PERCENT / 100) : 512) * 2;
+  uint8_t wbar = LCD_W / 2 - 20;
+  auto outputsCount = min<uint8_t>(16, reusableBuffer.hardwareAndSettings.receiverSettings.outputsCount);
+
+  SIMPLE_SUBMENU(STR_RECEIVER_OPTIONS, ICON_RADIO, ITEM_RECEIVER_PINMAP_FIRST + outputsCount);
+
+  if (event == EVT_ENTRY) {
+#if defined(SIMU)
+    reusableBuffer.hardwareAndSettings.receiverSettings.state = PXX2_SETTINGS_OK;
+    reusableBuffer.hardwareAndSettings.receiverSettings.outputsCount = 8;
+#else
+    // no need to initialize reusableBuffer.hardwareAndSettings.receiverSettings.state to PXX2_HARDWARE_INFO
+    moduleState[g_moduleIdx].readModuleInformation(&reusableBuffer.hardwareAndSettings.modules[g_moduleIdx], reusableBuffer.hardwareAndSettings.receiverSettings.receiverId, reusableBuffer.hardwareAndSettings.receiverSettings.receiverId);
+#endif
+  }
+
+  if (reusableBuffer.hardwareAndSettings.receiverSettings.state == PXX2_HARDWARE_INFO && moduleState[g_moduleIdx].mode == MODULE_MODE_NORMAL) {
+    reusableBuffer.hardwareAndSettings.receiverSettings.state = PXX2_SETTINGS_READ;
+    moduleState[g_moduleIdx].mode = MODULE_MODE_RECEIVER_SETTINGS;
+  }
+
+  if (menuEvent) {
+    moduleState[g_moduleIdx].mode = MODULE_MODE_NORMAL;
+    if (reusableBuffer.hardwareAndSettings.receiverSettings.dirty) {
+      abortPopMenu();
+      POPUP_CONFIRMATION("Update RX options?", onRxOptionsUpdateConfirm);
+    }
+    else {
+      return true;
+    }
+  }
+
+  if (event == EVT_KEY_LONG(KEY_ENTER) && reusableBuffer.hardwareAndSettings.receiverSettings.dirty) {
+    killEvents(event);
+    reusableBuffer.hardwareAndSettings.receiverSettings.state = PXX2_SETTINGS_WRITE;
+    reusableBuffer.hardwareAndSettings.receiverSettings.dirty = 0;
+    reusableBuffer.hardwareAndSettings.receiverSettings.timeout = 0;
+    moduleState[g_moduleIdx].mode = MODULE_MODE_RECEIVER_SETTINGS;
+  }
+
+  if (reusableBuffer.hardwareAndSettings.receiverSettings.dirty == 2 && reusableBuffer.hardwareAndSettings.receiverSettings.state == PXX2_SETTINGS_OK) {
+    popMenu();
+    return true;
+  }
+
+  int8_t sub = menuVerticalPosition;
+  drawReceiverName(130, 0, g_moduleIdx, reusableBuffer.hardwareAndSettings.receiverSettings.receiverId);
+
+  if (reusableBuffer.hardwareAndSettings.receiverSettings.state == PXX2_SETTINGS_OK) {
+    for (uint8_t k=0; k<NUM_BODY_LINES+1; k++) {
+      coord_t y = MENU_HEADER_HEIGHT + 1 + k*FH;
+      uint8_t i = k + menuVerticalOffset;
+      LcdFlags attr = (sub==i ? (s_editMode>0 ? BLINK|INVERS : INVERS) : 0);
+
+      switch (i) {
+        case ITEM_RECEIVER_TELEMETRY:
+          lcdDrawText(MENUS_MARGIN_LEFT, y, "Telemetry disabled");
+          reusableBuffer.hardwareAndSettings.receiverSettings.telemetryDisabled = editCheckBox(reusableBuffer.hardwareAndSettings.receiverSettings.telemetryDisabled, RECEIVER_OPTIONS_2ND_COLUMN, y, attr, event);
+          if (attr && checkIncDec_Ret) {
+            reusableBuffer.hardwareAndSettings.receiverSettings.dirty = true;
+          }
+          break;
+
+        case ITEM_RECEIVER_PWM_RATE:
+          lcdDrawText(MENUS_MARGIN_LEFT, y, isModuleR9M2(g_moduleIdx) ? "6.67ms PWM": "9ms PWM");
+          reusableBuffer.hardwareAndSettings.receiverSettings.pwmRate = editCheckBox(reusableBuffer.hardwareAndSettings.receiverSettings.pwmRate, RECEIVER_OPTIONS_2ND_COLUMN, y, attr, event);
+          if (attr && checkIncDec_Ret) {
+            reusableBuffer.hardwareAndSettings.receiverSettings.dirty = true;
+          }
+          break;
+
+        default:
+          // Pin
+        {
+          uint8_t pin = i - ITEM_RECEIVER_PINMAP_FIRST;
+          if (pin < reusableBuffer.hardwareAndSettings.receiverSettings.outputsCount) {
+            uint8_t channel = g_model.moduleData[g_moduleIdx].channelsStart + reusableBuffer.hardwareAndSettings.receiverSettings.outputsMapping[pin];
+            int32_t channelValue = channelOutputs[channel];
+            lcdDrawText(0, y, "Pin");
+            lcdDrawNumber(lcdNextPos + 1, y, pin + 1);
+            putsChn(80, y, channel + 1, attr);
+
+            // Channel
+            if (attr) {
+              channel = checkIncDec(event, channel, 0, sentModuleChannels(g_moduleIdx) - 1);
+              if (checkIncDec_Ret) {
+                reusableBuffer.hardwareAndSettings.receiverSettings.outputsMapping[pin] = channel;
+                reusableBuffer.hardwareAndSettings.receiverSettings.dirty = true;
+              }
+            }
+
+            // Bargraph
+#if !defined(PCBX7) // X7 LCD doesn't like too many horizontal lines
+            lcdDrawRect(LCD_W - 3 - wbar, y + 1, wbar + 1, 4);
+#endif
+            const uint8_t lenChannel = limit<uint8_t>(1, (abs(channelValue) * wbar / 2 + lim / 2) / lim, wbar / 2);
+            const coord_t xChannel = (channelValue > 0) ? LCD_W - 3 - wbar / 2 : LCD_W - 2 - wbar / 2 - lenChannel;
+            lcdDrawHorizontalLine(xChannel, y + 2, lenChannel, SOLID, 0);
+            lcdDrawHorizontalLine(xChannel, y + 3, lenChannel, SOLID, 0);
+          }
+          break;
+        }
+      }
+    }
+  }
+  else {
+    lcdDrawCenteredText(LCD_H/2, "Waiting for RX...");
+  }
+}