182 lines
6.4 KiB
C++
182 lines
6.4 KiB
C++
/*
|
|
* 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"
|
|
|
|
#define EXPO_ONE_2ND_COLUMN (7*FW+3*FW+2)
|
|
#define EXPO_ONE_FM_WIDTH (5*FW)
|
|
|
|
int expoFn(int x)
|
|
{
|
|
ExpoData * ed = expoAddress(s_currIdx);
|
|
int16_t anas[NUM_INPUTS] = {0};
|
|
applyExpos(anas, e_perout_mode_inactive_flight_mode, ed->srcRaw, x);
|
|
return anas[ed->chn];
|
|
}
|
|
|
|
void drawFunction(FnFuncP fn, uint8_t offset)
|
|
{
|
|
lcdDrawVerticalLine(CURVE_CENTER_X-offset, 0/*TODO CURVE_CENTER_Y-CURVE_SIDE_WIDTH*/, CURVE_SIDE_WIDTH*2, 0xee);
|
|
lcdDrawHorizontalLine(CURVE_CENTER_X-CURVE_SIDE_WIDTH-offset, CURVE_CENTER_Y, CURVE_SIDE_WIDTH*2, 0xee);
|
|
|
|
coord_t prev_yv = (coord_t)-1;
|
|
|
|
for (int xv=-CURVE_SIDE_WIDTH; xv<=CURVE_SIDE_WIDTH; xv++) {
|
|
coord_t yv = (LCD_H-1) - (((uint16_t)RESX + fn(xv * (RESX/CURVE_SIDE_WIDTH))) / 2 * (LCD_H-1) / RESX);
|
|
if (prev_yv != (coord_t)-1) {
|
|
if (abs((int8_t)yv-prev_yv) <= 1) {
|
|
lcdDrawPoint(CURVE_CENTER_X+xv-offset-1, prev_yv, FORCE);
|
|
}
|
|
else {
|
|
uint8_t tmp = (prev_yv < yv ? 0 : 1);
|
|
lcdDrawSolidVerticalLine(CURVE_CENTER_X+xv-offset-1, yv+tmp, prev_yv-yv);
|
|
}
|
|
}
|
|
prev_yv = yv;
|
|
}
|
|
}
|
|
|
|
enum ExposFields {
|
|
EXPO_FIELD_INPUT_NAME,
|
|
EXPO_FIELD_LINE_NAME,
|
|
EXPO_FIELD_SOURCE,
|
|
EXPO_FIELD_SCALE,
|
|
EXPO_FIELD_WEIGHT,
|
|
EXPO_FIELD_OFFSET,
|
|
EXPO_FIELD_CURVE_LABEL,
|
|
EXPO_FIELD_CURVE,
|
|
CASE_FLIGHT_MODES(EXPO_FIELD_FLIGHT_MODES_LABEL)
|
|
CASE_FLIGHT_MODES(EXPO_FIELD_FLIGHT_MODES)
|
|
EXPO_FIELD_SWITCH,
|
|
EXPO_FIELD_SIDE,
|
|
EXPO_FIELD_TRIM,
|
|
EXPO_FIELD_MAX
|
|
};
|
|
|
|
void menuModelExpoOne(event_t event)
|
|
{
|
|
ExpoData * ed = expoAddress(s_currIdx);
|
|
drawSource(PSIZE(TR_MENUINPUTS)*FW+FW, 0, MIXSRC_FIRST_INPUT+ed->chn, 0);
|
|
|
|
SUBMENU(STR_MENUINPUTS, EXPO_FIELD_MAX, {0, 0, 0, ed->srcRaw >= MIXSRC_FIRST_TELEM ? (uint8_t)0 : (uint8_t)HIDDEN_ROW, 0, 0, LABEL(Curve), 1, CASE_FLIGHT_MODES(LABEL(Flight Mode)) CASE_FLIGHT_MODES((MAX_FLIGHT_MODES-1) | NAVIGATION_LINE_BY_LINE) 0 /*, ...*/});
|
|
|
|
int8_t sub = menuVerticalPosition;
|
|
|
|
coord_t y = MENU_HEADER_HEIGHT + 1;
|
|
|
|
for (uint8_t k=0; k<NUM_BODY_LINES; k++) {
|
|
int i = k + menuVerticalOffset;
|
|
for (int j=0; j<=i; ++j) {
|
|
if (j<(int)DIM(mstate_tab) && mstate_tab[j] == HIDDEN_ROW) {
|
|
++i;
|
|
}
|
|
}
|
|
LcdFlags attr = (sub==i ? (s_editMode>0 ? BLINK|INVERS : INVERS) : 0);
|
|
|
|
switch (i) {
|
|
case EXPO_FIELD_INPUT_NAME:
|
|
editSingleName(EXPO_ONE_2ND_COLUMN-LEN_INPUT_NAME*FW, y, STR_INPUTNAME, g_model.inputNames[ed->chn], LEN_INPUT_NAME, event, attr);
|
|
break;
|
|
|
|
case EXPO_FIELD_LINE_NAME:
|
|
editSingleName(EXPO_ONE_2ND_COLUMN-LEN_EXPOMIX_NAME*FW, y, STR_EXPONAME, ed->name, LEN_EXPOMIX_NAME, event, attr);
|
|
break;
|
|
|
|
case EXPO_FIELD_SOURCE:
|
|
lcdDrawTextAlignedLeft(y, NO_INDENT(STR_SOURCE));
|
|
drawSource(EXPO_ONE_2ND_COLUMN, y, ed->srcRaw, RIGHT|STREXPANDED|attr);
|
|
if (attr) ed->srcRaw = checkIncDec(event, ed->srcRaw, INPUTSRC_FIRST, INPUTSRC_LAST, EE_MODEL|INCDEC_SOURCE|NO_INCDEC_MARKS, isInputSourceAvailable);
|
|
break;
|
|
|
|
case EXPO_FIELD_SCALE:
|
|
lcdDrawTextAlignedLeft(y, STR_SCALE);
|
|
drawSensorCustomValue(EXPO_ONE_2ND_COLUMN, y, (ed->srcRaw - MIXSRC_FIRST_TELEM)/3, convertTelemValue(ed->srcRaw - MIXSRC_FIRST_TELEM + 1, ed->scale), attr);
|
|
if (attr) ed->scale = checkIncDec(event, ed->scale, 0, maxTelemValue(ed->srcRaw - MIXSRC_FIRST_TELEM + 1), EE_MODEL);
|
|
break;
|
|
|
|
case EXPO_FIELD_WEIGHT:
|
|
lcdDrawTextAlignedLeft(y, STR_WEIGHT);
|
|
ed->weight = GVAR_MENU_ITEM(EXPO_ONE_2ND_COLUMN, y, ed->weight, MIN_EXPO_WEIGHT, 100, RIGHT | attr, 0, event);
|
|
break;
|
|
|
|
case EXPO_FIELD_OFFSET:
|
|
lcdDrawTextAlignedLeft(y, NO_INDENT(STR_OFFSET));
|
|
ed->offset = GVAR_MENU_ITEM(EXPO_ONE_2ND_COLUMN, y, ed->offset, -100, 100, RIGHT | attr, 0, event);
|
|
break;
|
|
|
|
case EXPO_FIELD_CURVE_LABEL:
|
|
lcdDrawTextAlignedLeft(y, STR_CURVE);
|
|
break;
|
|
|
|
case EXPO_FIELD_CURVE:
|
|
editCurveRef(EXPO_ONE_2ND_COLUMN, y, ed->curve, s_editMode > 0 ? event : 0, RIGHT | attr);
|
|
break;
|
|
|
|
#if defined(FLIGHT_MODES)
|
|
case EXPO_FIELD_FLIGHT_MODES_LABEL:
|
|
lcdDrawTextAlignedLeft(y, STR_FLMODE);
|
|
break;
|
|
|
|
case EXPO_FIELD_FLIGHT_MODES:
|
|
ed->flightModes = editFlightModes(EXPO_ONE_2ND_COLUMN-9*FW+1, y, event, ed->flightModes, attr);
|
|
break;
|
|
#endif
|
|
|
|
case EXPO_FIELD_SWITCH:
|
|
ed->swtch = editSwitch(EXPO_ONE_2ND_COLUMN, y, ed->swtch, RIGHT | attr, event);
|
|
break;
|
|
|
|
case EXPO_FIELD_SIDE:
|
|
ed->mode = 4 - editChoice(EXPO_ONE_2ND_COLUMN, y, STR_SIDE, STR_VCURVEFUNC, 4-ed->mode, 1, 3, RIGHT | attr, event);
|
|
break;
|
|
|
|
case EXPO_FIELD_TRIM:
|
|
uint8_t not_stick = (ed->srcRaw > MIXSRC_Ail);
|
|
int8_t carryTrim = -ed->carryTrim;
|
|
lcdDrawTextAlignedLeft(y, STR_TRIM);
|
|
lcdDrawTextAtIndex(EXPO_ONE_2ND_COLUMN, y, STR_VMIXTRIMS, (not_stick && carryTrim == 0) ? 0 : carryTrim+1, RIGHT | (menuHorizontalPosition==0 ? attr : 0));
|
|
if (attr) ed->carryTrim = -checkIncDecModel(event, carryTrim, not_stick ? TRIM_ON : -TRIM_OFF, -TRIM_LAST);
|
|
break;
|
|
}
|
|
y += FH;
|
|
}
|
|
|
|
drawFunction(expoFn);
|
|
|
|
int x512 = getValue(ed->srcRaw);
|
|
if (ed->srcRaw >= MIXSRC_FIRST_TELEM) {
|
|
drawSensorCustomValue(LCD_W-FW, 6*FH, (ed->srcRaw - MIXSRC_FIRST_TELEM) / 3, x512, 0);
|
|
if (ed->scale > 0) x512 = (x512 * 1024) / convertTelemValue(ed->srcRaw - MIXSRC_FIRST_TELEM + 1, ed->scale);
|
|
}
|
|
else {
|
|
lcdDrawNumber(LCD_W-FW, 6*FH, calcRESXto1000(x512), RIGHT | PREC1);
|
|
}
|
|
x512 = limit(-1024, x512, 1024);
|
|
int y512 = expoFn(x512);
|
|
y512 = limit(-1024, y512, 1024);
|
|
lcdDrawNumber(CURVE_CENTER_X-FWNUM, 1*FH, calcRESXto1000(y512), RIGHT | PREC1);
|
|
|
|
x512 = CURVE_CENTER_X+x512/(RESX/CURVE_SIDE_WIDTH);
|
|
y512 = (LCD_H-1) - ((y512+RESX)/2) * (LCD_H-1) / RESX;
|
|
|
|
lcdDrawSolidVerticalLine(x512, y512-3, 3*2+1);
|
|
lcdDrawSolidHorizontalLine(x512-3, y512, 3*2+1);
|
|
}
|