Powermeter added

2019-03-20 08:46:47 +01:00
parent 1539bdb909
commit 775ac40aaa
13 changed files with 143 additions and 44 deletions
@@ -0,0 +1,64 @@
+/*
+ * Copyright (C) OpenTX
+ *
+ * Based on code named
+ *   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 <opentx.h>
+#include "opentx.h"
+
+void menuRadioPowerMeter(event_t event)
+{
+  SIMPLE_SUBMENU("POWER METER", 1);
+
+  if (menuEvent) {
+    INTERNAL_MODULE_OFF();
+    moduleSettings[INTERNAL_MODULE].mode = MODULE_MODE_NORMAL;
+    /* wait 500ms off */
+    watchdogSuspend(500);
+    RTOS_WAIT_MS(500);
+    INTERNAL_MODULE_ON();
+  }
+  else if (event == EVT_ENTRY) {
+    memclear(&reusableBuffer.powerMeter, sizeof(reusableBuffer.powerMeter));
+    reusableBuffer.powerMeter.freq = 2400;
+    moduleSettings[INTERNAL_MODULE].mode = MODULE_MODE_POWER_METER;
+  }
+
+  coord_t y = MENU_HEADER_HEIGHT + 1 + FH;
+  LcdFlags attr = (menuVerticalPosition - HEADER_LINE == 0 ? INVERS : 0);
+  lcdDrawText(0, y, "Freq.");
+  lcdDrawNumber(8*FW, y, reusableBuffer.powerMeter.freq, LEFT|attr|(s_editMode > 0 ? BLINK : 0));
+  lcdDrawText(lcdNextPos, y, "MHz");
+  if (attr) {
+    CHECK_INCDEC_MODELVAR(event, reusableBuffer.powerMeter.freq, 2300, 2500);
+    if (checkIncDec_Ret) {
+      reusableBuffer.powerMeter.power = 0;
+      reusableBuffer.powerMeter.peak = 0;
+    }
+  }
+
+  y += FH + 1;
+  lcdDrawText(0, y, "Power");
+  lcdDrawNumber(8*FW, y, reusableBuffer.powerMeter.power, LEFT);
+  lcdDrawText(lcdNextPos, y, "dBm");
+
+  y += FH + 1;
+  lcdDrawText(0, y, "Peak");
+  lcdDrawNumber(8*FW, y, reusableBuffer.powerMeter.peak, LEFT);
+  lcdDrawText(lcdNextPos, y, "dBm");
+}