@@ -20,6 +20,15 @@
|
|||||||
|
|
||||||
#include "opentx.h"
|
#include "opentx.h"
|
||||||
|
|
||||||
|
#if defined(HARDWARE_NO_TRIMS)
|
||||||
|
struct {
|
||||||
|
int8_t preStickIdx = -1;
|
||||||
|
int8_t curStickIdx = -1;
|
||||||
|
tmr10ms_t preEnterTime;
|
||||||
|
bool preEnterValid = false;
|
||||||
|
} trimSelection;
|
||||||
|
#endif
|
||||||
|
|
||||||
#define BIGSIZE DBLSIZE
|
#define BIGSIZE DBLSIZE
|
||||||
#if defined (PCBTARANIS)
|
#if defined (PCBTARANIS)
|
||||||
#define LBOX_CENTERX (LCD_W/4 + 14)
|
#define LBOX_CENTERX (LCD_W/4 + 14)
|
||||||
@@ -98,6 +107,35 @@ void doMainScreenGraphics()
|
|||||||
drawPotsBars();
|
drawPotsBars();
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#if defined(HARDWARE_NO_TRIMS)
|
||||||
|
void doMainScreenGraphics(uint8_t views, uint32_t ptr)
|
||||||
|
{
|
||||||
|
int16_t * calibStickValPtr = nullptr;
|
||||||
|
int16_t calibStickVert = 0;
|
||||||
|
|
||||||
|
if (ptr)
|
||||||
|
calibStickValPtr = (int16_t *)(ptr);
|
||||||
|
else
|
||||||
|
calibStickValPtr = calibratedAnalogs;
|
||||||
|
calibStickVert = calibStickValPtr[CONVERT_MODE(1)];
|
||||||
|
|
||||||
|
if (views & MAINSCREEN_GRAPHICS_STICKS) {
|
||||||
|
if (g_model.throttleReversed && CONVERT_MODE(1) == THR_STICK)
|
||||||
|
calibStickVert = -calibStickVert;
|
||||||
|
drawStick(LBOX_CENTERX, calibStickValPtr[CONVERT_MODE(0)], calibStickVert);
|
||||||
|
|
||||||
|
calibStickVert = calibStickValPtr[CONVERT_MODE(2)];
|
||||||
|
if (g_model.throttleReversed && CONVERT_MODE(2) == THR_STICK)
|
||||||
|
calibStickVert = -calibStickVert;
|
||||||
|
drawStick(RBOX_CENTERX, calibStickValPtr[CONVERT_MODE(3)], calibStickVert);
|
||||||
|
}
|
||||||
|
|
||||||
|
if (views & MAINSCREEN_GRAPHICS_POTS) {
|
||||||
|
drawPotsBars();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
void displayTrims(uint8_t phase)
|
void displayTrims(uint8_t phase)
|
||||||
{
|
{
|
||||||
for (uint8_t i = 0; i < 4; i++) {
|
for (uint8_t i = 0; i < 4; i++) {
|
||||||
@@ -128,12 +166,30 @@ void displayTrims(uint8_t phase)
|
|||||||
}
|
}
|
||||||
|
|
||||||
if (vert[i]) {
|
if (vert[i]) {
|
||||||
|
#if defined(HARDWARE_NO_TRIMS)
|
||||||
|
ym = 61;
|
||||||
|
if (trimSelection.curStickIdx == i) {
|
||||||
|
lcdDrawSolidVerticalLine(xm, ym - TRIM_LEN, TRIM_LEN * 2);
|
||||||
|
if (i != 2 || !g_model.thrTrim) {
|
||||||
|
lcdDrawSolidVerticalLine(xm - 1, ym - TRIM_LEN, TRIM_LEN * 2);
|
||||||
|
lcdDrawSolidVerticalLine(xm + 1, ym - TRIM_LEN, TRIM_LEN * 2);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
else {
|
||||||
|
lcdDrawSolidVerticalLine(xm, ym - TRIM_LEN, TRIM_LEN * 2);
|
||||||
|
if (i != 2 || !g_model.thrTrim) {
|
||||||
|
lcdDrawSolidVerticalLine(xm - 1, ym - 1, 3);
|
||||||
|
lcdDrawSolidVerticalLine(xm + 1, ym - 1, 3);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
#else
|
||||||
ym = 31;
|
ym = 31;
|
||||||
lcdDrawSolidVerticalLine(xm, ym - TRIM_LEN, TRIM_LEN * 2);
|
lcdDrawSolidVerticalLine(xm, ym - TRIM_LEN, TRIM_LEN * 2);
|
||||||
if (i != 2 || !g_model.thrTrim) {
|
if (i != 2 || !g_model.thrTrim) {
|
||||||
lcdDrawSolidVerticalLine(xm - 1, ym - 1, 3);
|
lcdDrawSolidVerticalLine(xm - 1, ym - 1, 3);
|
||||||
lcdDrawSolidVerticalLine(xm + 1, ym - 1, 3);
|
lcdDrawSolidVerticalLine(xm + 1, ym - 1, 3);
|
||||||
}
|
}
|
||||||
|
#endif
|
||||||
ym -= val;
|
ym -= val;
|
||||||
lcdDrawFilledRect(xm - 3, ym - 3, 7, 7, SOLID, att | ERASE);
|
lcdDrawFilledRect(xm - 3, ym - 3, 7, 7, SOLID, att | ERASE);
|
||||||
if (dir >= 0) {
|
if (dir >= 0) {
|
||||||
@@ -152,10 +208,24 @@ void displayTrims(uint8_t phase)
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
else {
|
else {
|
||||||
|
#if defined(HARDWARE_NO_TRIMS)
|
||||||
|
ym = 92;
|
||||||
|
if (trimSelection.curStickIdx == i) {
|
||||||
|
lcdDrawSolidHorizontalLine(xm - TRIM_LEN, ym, TRIM_LEN * 2);
|
||||||
|
lcdDrawSolidHorizontalLine(xm - TRIM_LEN, ym - 1, TRIM_LEN * 2);
|
||||||
|
lcdDrawSolidHorizontalLine(xm - TRIM_LEN, ym + 1, TRIM_LEN * 2);
|
||||||
|
}
|
||||||
|
else {
|
||||||
|
lcdDrawSolidHorizontalLine(xm - TRIM_LEN, ym, TRIM_LEN * 2);
|
||||||
|
lcdDrawSolidHorizontalLine(xm - 1, ym - 1, 3);
|
||||||
|
lcdDrawSolidHorizontalLine(xm - 1, ym + 1, 3);
|
||||||
|
}
|
||||||
|
#else
|
||||||
ym = 60;
|
ym = 60;
|
||||||
lcdDrawSolidHorizontalLine(xm - TRIM_LEN, ym, TRIM_LEN * 2);
|
lcdDrawSolidHorizontalLine(xm - TRIM_LEN, ym, TRIM_LEN * 2);
|
||||||
lcdDrawSolidHorizontalLine(xm - 1, ym - 1, 3);
|
lcdDrawSolidHorizontalLine(xm - 1, ym - 1, 3);
|
||||||
lcdDrawSolidHorizontalLine(xm - 1, ym + 1, 3);
|
lcdDrawSolidHorizontalLine(xm - 1, ym + 1, 3);
|
||||||
|
#endif
|
||||||
xm += val;
|
xm += val;
|
||||||
lcdDrawFilledRect(xm - 3, ym - 3, 7, 7, SOLID, att | ERASE);
|
lcdDrawFilledRect(xm - 3, ym - 3, 7, 7, SOLID, att | ERASE);
|
||||||
if (dir >= 0) {
|
if (dir >= 0) {
|
||||||
@@ -184,6 +254,12 @@ void displayBattVoltage()
|
|||||||
lcdDrawSolidFilledRect(VBATT_X - 25, VBATT_Y + 9, 21, 5);
|
lcdDrawSolidFilledRect(VBATT_X - 25, VBATT_Y + 9, 21, 5);
|
||||||
lcdDrawSolidVerticalLine(VBATT_X - 4, VBATT_Y + 10, 3);
|
lcdDrawSolidVerticalLine(VBATT_X - 4, VBATT_Y + 10, 3);
|
||||||
uint8_t count = GET_TXBATT_BARS(20);
|
uint8_t count = GET_TXBATT_BARS(20);
|
||||||
|
|
||||||
|
#if defined(HARDWARE_CHARGING_STATE)
|
||||||
|
if (IS_CHARGING_STATE()) {
|
||||||
|
count = (get_tmr10ms() & 127u) * count / 128;
|
||||||
|
}
|
||||||
|
#endif
|
||||||
for (uint8_t i = 0; i < count; i += 2)
|
for (uint8_t i = 0; i < count; i += 2)
|
||||||
lcdDrawSolidVerticalLine(VBATT_X - 24 + i, VBATT_Y + 10, 3);
|
lcdDrawSolidVerticalLine(VBATT_X - 24 + i, VBATT_Y + 10, 3);
|
||||||
if (!IS_TXBATT_WARNING() || BLINK_ON_PHASE)
|
if (!IS_TXBATT_WARNING() || BLINK_ON_PHASE)
|
||||||
@@ -210,7 +286,7 @@ void displayVoltageOrAlarm()
|
|||||||
#define displayVoltageOrAlarm() displayBattVoltage()
|
#define displayVoltageOrAlarm() displayBattVoltage()
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#if defined(NAVIGATION_X7)
|
#if defined(NAVIGATION_X7) || defined(NAVIGATION_TBS)
|
||||||
#define EVT_KEY_CONTEXT_MENU EVT_KEY_LONG(KEY_ENTER)
|
#define EVT_KEY_CONTEXT_MENU EVT_KEY_LONG(KEY_ENTER)
|
||||||
#define EVT_KEY_NEXT_VIEW EVT_KEY_BREAK(KEY_PAGE)
|
#define EVT_KEY_NEXT_VIEW EVT_KEY_BREAK(KEY_PAGE)
|
||||||
#define EVT_KEY_NEXT_PAGE EVT_ROTARY_RIGHT
|
#define EVT_KEY_NEXT_PAGE EVT_ROTARY_RIGHT
|
||||||
@@ -331,11 +407,21 @@ void menuMainView(event_t event)
|
|||||||
*/
|
*/
|
||||||
case EVT_KEY_NEXT_PAGE:
|
case EVT_KEY_NEXT_PAGE:
|
||||||
case EVT_KEY_PREVIOUS_PAGE:
|
case EVT_KEY_PREVIOUS_PAGE:
|
||||||
|
#if defined(HARDWARE_NO_TRIMS)
|
||||||
|
if (g_trimEditMode == EDIT_TRIM_DISABLED) {
|
||||||
|
if (view_base == VIEW_INPUTS)
|
||||||
|
g_eeGeneral.view ^= ALTERNATE_VIEW;
|
||||||
|
else
|
||||||
|
g_eeGeneral.view = (g_eeGeneral.view + (4 * ALTERNATE_VIEW) + ((event == EVT_KEY_PREVIOUS_PAGE) ? -ALTERNATE_VIEW : ALTERNATE_VIEW)) % (4 * ALTERNATE_VIEW);
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
#else
|
||||||
if (view_base == VIEW_INPUTS)
|
if (view_base == VIEW_INPUTS)
|
||||||
g_eeGeneral.view ^= ALTERNATE_VIEW;
|
g_eeGeneral.view ^= ALTERNATE_VIEW;
|
||||||
else
|
else
|
||||||
g_eeGeneral.view = (g_eeGeneral.view + (4 * ALTERNATE_VIEW) + ((event == EVT_KEY_PREVIOUS_PAGE) ? -ALTERNATE_VIEW : ALTERNATE_VIEW)) % (4 * ALTERNATE_VIEW);
|
g_eeGeneral.view = (g_eeGeneral.view + (4 * ALTERNATE_VIEW) + ((event == EVT_KEY_PREVIOUS_PAGE) ? -ALTERNATE_VIEW : ALTERNATE_VIEW)) % (4 * ALTERNATE_VIEW);
|
||||||
break;
|
break;
|
||||||
|
#endif
|
||||||
|
|
||||||
case EVT_KEY_CONTEXT_MENU:
|
case EVT_KEY_CONTEXT_MENU:
|
||||||
killEvents(event);
|
killEvents(event);
|
||||||
@@ -369,7 +455,38 @@ void menuMainView(event_t event)
|
|||||||
killEvents(event);
|
killEvents(event);
|
||||||
break;
|
break;
|
||||||
#endif
|
#endif
|
||||||
|
#if defined(HARDWARE_NO_TRIMS)
|
||||||
|
case EVT_KEY_FIRST(KEY_ENTER):
|
||||||
|
if (!trimSelection.preEnterValid) {
|
||||||
|
trimSelection.preEnterValid = true;
|
||||||
|
trimSelection.preEnterTime = get_tmr10ms();
|
||||||
|
}
|
||||||
|
else {
|
||||||
|
trimSelection.preEnterValid = false;
|
||||||
|
if (++g_trimEditMode > EDIT_TRIM_MAX) {
|
||||||
|
g_trimEditMode = EDIT_TRIM_1;
|
||||||
|
}
|
||||||
|
|
||||||
|
trimSelection.curStickIdx = CONVERT_MODE_TRIMS(g_trimEditMode - 1);
|
||||||
|
|
||||||
|
if (trimSelection.preStickIdx != trimSelection.curStickIdx) {
|
||||||
|
if (trimSelection.curStickIdx == RUD_STICK) {
|
||||||
|
AUDIO_RUDDER_TRIM();
|
||||||
|
}
|
||||||
|
else if (trimSelection.curStickIdx == ELE_STICK) {
|
||||||
|
AUDIO_ELEVATOR_TRIM();
|
||||||
|
}
|
||||||
|
else if (trimSelection.curStickIdx == THR_STICK) {
|
||||||
|
AUDIO_THROTTLE_TRIM();
|
||||||
|
}
|
||||||
|
else if (trimSelection.curStickIdx == AIL_STICK) {
|
||||||
|
AUDIO_AILERON_TRIM();
|
||||||
|
}
|
||||||
|
trimSelection.preStickIdx = trimSelection.curStickIdx;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
#endif
|
||||||
#if defined(EVT_KEY_PREVIOUS_VIEW)
|
#if defined(EVT_KEY_PREVIOUS_VIEW)
|
||||||
// TODO try to split those 2 cases on 9X
|
// TODO try to split those 2 cases on 9X
|
||||||
case EVT_KEY_PREVIOUS_VIEW:
|
case EVT_KEY_PREVIOUS_VIEW:
|
||||||
@@ -403,9 +520,22 @@ void menuMainView(event_t event)
|
|||||||
if (gvarDisplayTimer > 0) {
|
if (gvarDisplayTimer > 0) {
|
||||||
gvarDisplayTimer = 0;
|
gvarDisplayTimer = 0;
|
||||||
}
|
}
|
||||||
|
#endif
|
||||||
|
#if defined(HARDWARE_NO_TRIMS)
|
||||||
|
if (g_trimEditMode != EDIT_TRIM_DISABLED) {
|
||||||
|
g_trimEditMode = EDIT_TRIM_DISABLED;
|
||||||
|
AUDIO_MAIN_MENU();
|
||||||
|
trimSelection.curStickIdx = -1;
|
||||||
|
trimSelection.preStickIdx = -1;
|
||||||
|
}
|
||||||
#endif
|
#endif
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
|
#if defined(HARDWARE_NO_TRIMS)
|
||||||
|
if (trimSelection.preEnterValid && (get_tmr10ms() - trimSelection.preEnterTime) > 50) {
|
||||||
|
trimSelection.preEnterValid = false;
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
switch (view_base) {
|
switch (view_base) {
|
||||||
case VIEW_CHAN_MONITOR:
|
case VIEW_CHAN_MONITOR:
|
||||||
@@ -424,7 +554,11 @@ void menuMainView(event_t event)
|
|||||||
|
|
||||||
if (view_base == VIEW_OUTPUTS_VALUES) {
|
if (view_base == VIEW_OUTPUTS_VALUES) {
|
||||||
x0 = (i % 4 * 9 + 3) * FW / 2;
|
x0 = (i % 4 * 9 + 3) * FW / 2;
|
||||||
|
#if LCD_H == 96
|
||||||
|
y0 = i / 4 * FH * 2 + 50;
|
||||||
|
#else
|
||||||
y0 = i / 4 * FH + 40;
|
y0 = i / 4 * FH + 40;
|
||||||
|
#endif
|
||||||
#if defined(PPM_UNIT_US)
|
#if defined(PPM_UNIT_US)
|
||||||
lcdDrawNumber(x0 + 4 * FW, y0, PPM_CH_CENTER(chan) + val / 2, RIGHT);
|
lcdDrawNumber(x0 + 4 * FW, y0, PPM_CH_CENTER(chan) + val / 2, RIGHT);
|
||||||
#elif defined(PPM_UNIT_PERCENT_PREC1)
|
#elif defined(PPM_UNIT_PERCENT_PREC1)
|
||||||
@@ -436,7 +570,11 @@ void menuMainView(event_t event)
|
|||||||
else {
|
else {
|
||||||
constexpr coord_t WBAR2 = (50 / 2);
|
constexpr coord_t WBAR2 = (50 / 2);
|
||||||
x0 = i < 4 ? LCD_W / 4 + 2 : LCD_W * 3 / 4 - 2;
|
x0 = i < 4 ? LCD_W / 4 + 2 : LCD_W * 3 / 4 - 2;
|
||||||
|
#if LCD_H == 96
|
||||||
|
y0 = 45 + (i % 4) * 10;
|
||||||
|
#else
|
||||||
y0 = 38 + (i % 4) * 5;
|
y0 = 38 + (i % 4) * 5;
|
||||||
|
#endif
|
||||||
|
|
||||||
const uint16_t lim = (g_model.extendedLimits ? (512 * (long) LIMIT_EXT_PERCENT / 100) : 512) * 2;
|
const uint16_t lim = (g_model.extendedLimits ? (512 * (long) LIMIT_EXT_PERCENT / 100) : 512) * 2;
|
||||||
int8_t len = (abs(val) * WBAR2 + lim / 2) / lim;
|
int8_t len = (abs(val) * WBAR2 + lim / 2) / lim;
|
||||||
@@ -511,6 +649,38 @@ void menuMainView(event_t event)
|
|||||||
drawSwitch(x, y, sw, 0, false);
|
drawSwitch(x, y, sw, 0, false);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
#elif defined(PCBTANGO)
|
||||||
|
int sw_i;
|
||||||
|
for (int i = 0; i < NUM_SWITCHES; ++i) {
|
||||||
|
if (SWITCH_EXISTS(i)) {
|
||||||
|
uint8_t x = 2 * FW - 2, y = 4 * FH + i * FH + 20;
|
||||||
|
if (i >= NUM_SWITCHES / 2) {
|
||||||
|
x = 16 * FW + 6;
|
||||||
|
y -= (NUM_SWITCHES / 2) * FH;
|
||||||
|
}
|
||||||
|
//TDOD : move switchReOrder definition in board.h
|
||||||
|
static const uint8_t switchReOrder[] = {0, 1, 5, 3, 2, 4};
|
||||||
|
|
||||||
|
// re-arrange order according to physical layout
|
||||||
|
i = switchReOrder[i];
|
||||||
|
getvalue_t val = getValue(MIXSRC_FIRST_SWITCH + sw_i);
|
||||||
|
getvalue_t sw = ((val < 0) ? 3 * sw_i + 1 : ((val == 0) ? 3 * sw_i + 2 : 3 * sw_i + 3));
|
||||||
|
drawSwitch(x, y, sw, 0);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
#elif defined(PCBMAMBO)
|
||||||
|
for (int i = 0; i < NUM_SWITCHES; ++i) {
|
||||||
|
if (SWITCH_EXISTS(i)) {
|
||||||
|
uint8_t x = 2 * FW - 2, y = 4 * FH + i * FH + 1;
|
||||||
|
if (i >= NUM_SWITCHES / 2) {
|
||||||
|
x = 16 * FW + 6;
|
||||||
|
y -= (NUM_SWITCHES / 2) * FH;
|
||||||
|
}
|
||||||
|
getvalue_t val = getValue(MIXSRC_FIRST_SWITCH + i);
|
||||||
|
getvalue_t sw = ((val < 0) ? 3 * i + 1 : ((val == 0) ? 3 * i + 2 : 3 * i + 3));
|
||||||
|
drawSwitch(x, y, sw, 0);
|
||||||
|
}
|
||||||
|
}
|
||||||
#else
|
#else
|
||||||
// The ID0 3-POS switch is merged with the TRN switch
|
// The ID0 3-POS switch is merged with the TRN switch
|
||||||
for (uint8_t i = SWSRC_THR; i <= SWSRC_TRN; i++) {
|
for (uint8_t i = SWSRC_THR; i <= SWSRC_TRN; i++) {
|
||||||
|
|||||||
Reference in New Issue
Block a user