147 lines
3.9 KiB
C++
147 lines
3.9 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 "opentx.h"
|
|
#include "../../hal/adc_driver.h"
|
|
|
|
#define HOLDANAVALUEFRAMES 4 /* 4* 50ms = 200 ms update rate */
|
|
|
|
void menuRadioDiagAnalogs(event_t event)
|
|
{
|
|
static int8_t entryCount = 0;
|
|
static uint16_t lastShownAnalogValue[NUM_STICKS+NUM_POTS+NUM_SLIDERS];
|
|
|
|
enum ANAVIEWS{
|
|
ANAVIEW_FIRST,
|
|
ANAVIEW_CALIB=ANAVIEW_FIRST,
|
|
ANAVIEW_RAWLOWFPS,
|
|
ANAVIEW_LAST=ANAVIEW_RAWLOWFPS
|
|
};
|
|
|
|
static int viewpage = ANAVIEW_FIRST;
|
|
|
|
// TODO enum
|
|
#if defined(TX_CAPACITY_MEASUREMENT)
|
|
#define ANAS_ITEMS_COUNT 3
|
|
#else
|
|
#define ANAS_ITEMS_COUNT 1
|
|
#endif
|
|
|
|
switch (event) {
|
|
case EVT_KEY_FIRST(KEY_UP):
|
|
#if defined(KEYS_GPIO_REG_PAGEDN)
|
|
case EVT_KEY_BREAK(KEY_PAGEDN):
|
|
#elif defined(NAVIGATION_X7)
|
|
case EVT_KEY_BREAK(KEY_PAGE):
|
|
#endif
|
|
{
|
|
if (viewpage == ANAVIEW_LAST)
|
|
viewpage = ANAVIEW_FIRST;
|
|
else
|
|
viewpage++;
|
|
if (viewpage == ANAVIEW_RAWLOWFPS) entryCount = 0;
|
|
break;
|
|
}
|
|
|
|
case EVT_KEY_FIRST(KEY_DOWN):
|
|
#if defined(KEYS_GPIO_REG_PAGEUP)
|
|
case EVT_KEY_BREAK(KEY_PAGEUP):
|
|
#elif defined(NAVIGATION_X7)
|
|
case EVT_KEY_LONG(KEY_PAGE):
|
|
#endif
|
|
{
|
|
if (viewpage == ANAVIEW_FIRST)
|
|
viewpage = ANAVIEW_LAST;
|
|
else
|
|
viewpage--;
|
|
if (viewpage == ANAVIEW_RAWLOWFPS) entryCount = 0;
|
|
break;
|
|
}
|
|
}
|
|
|
|
switch (viewpage) {
|
|
case (ANAVIEW_CALIB):
|
|
SIMPLE_SUBMENU(STR_MENU_RADIO_ANALOGS_CALIB,
|
|
HEADER_LINE+ANAS_ITEMS_COUNT);
|
|
break;
|
|
case (ANAVIEW_RAWLOWFPS):
|
|
SIMPLE_SUBMENU(STR_MENU_RADIO_ANALOGS_RAWLOWFPS,
|
|
HEADER_LINE+ANAS_ITEMS_COUNT);
|
|
break;
|
|
}
|
|
|
|
coord_t y = MENU_HEADER_HEIGHT + 1;
|
|
|
|
lcdDrawTextAlignedLeft(y, STICKS_PWM_ENABLED() ? STR_PWM_STICKS_POTS_SLIDERS
|
|
: STR_STICKS_POTS_SLIDERS);
|
|
|
|
for (uint8_t i = 0; i < NUM_STICKS + NUM_POTS + NUM_SLIDERS; i++) {
|
|
uint8_t x;
|
|
if (i & 1) {
|
|
x = LCD_W / 2 + INDENT_WIDTH;
|
|
} else {
|
|
x = INDENT_WIDTH;
|
|
y += FH;
|
|
}
|
|
drawStringWithIndex(x, y, "A", i + 1);
|
|
lcdDrawChar(lcdNextPos, y, ':');
|
|
switch (viewpage) {
|
|
case (ANAVIEW_RAWLOWFPS):
|
|
if (entryCount == 0) {
|
|
lastShownAnalogValue[i] = getAnalogValue(i); // Update value
|
|
}
|
|
lcdDrawNumber(x+3*FW-1, y, lastShownAnalogValue[i],
|
|
LEADING0|LEFT, 4);
|
|
break;
|
|
case (ANAVIEW_CALIB):
|
|
default:
|
|
lcdDrawNumber(x+3*FW-1, y, anaIn(i), LEADING0|LEFT, 4);
|
|
break;
|
|
}
|
|
lcdDrawNumber(x+10*FW-1, y,
|
|
(int16_t)calibratedAnalogs[CONVERT_MODE(i)]*25/256,
|
|
RIGHT);
|
|
}
|
|
|
|
if (viewpage == ANAVIEW_RAWLOWFPS) {
|
|
if (entryCount > HOLDANAVALUEFRAMES)
|
|
entryCount = 0;
|
|
else
|
|
entryCount++;
|
|
}
|
|
|
|
#if defined(IMU)
|
|
y += FH;
|
|
lcdDrawTextAlignedLeft(y, STR_IMU);
|
|
y += FH;
|
|
uint8_t x = INDENT_WIDTH;
|
|
lcdDrawText(x, y, "X:");
|
|
lcdDrawNumber(x+3*FW-1, y, gyro.outputs[0] * 180 / 1024);
|
|
lcdDrawChar(lcdNextPos, y, '@');
|
|
lcdDrawNumber(x+10*FW-1, y, gyro.scaledX(), RIGHT);
|
|
x = LCD_W/2 + INDENT_WIDTH;
|
|
lcdDrawText(x, y, "Y:");
|
|
lcdDrawNumber(x+3*FW-1, y, gyro.outputs[1] * 180 / 1024);
|
|
lcdDrawChar(lcdNextPos, y, '@');
|
|
lcdDrawNumber(x+10*FW-1, y, gyro.scaledY(), RIGHT);
|
|
#endif
|
|
}
|