/* * 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" int circularIncDec(int current, int inc, int min, int max, IsValueAvailable isValueAvailable) { do { current += inc; if (current < min) current = max; else if (current > max) current = min; if (!isValueAvailable || isValueAvailable(current)) return current; } while(1); return 0; } bool isInputAvailable(int input) { for (int i=0; ichn == input) return true; } return false; } bool isSensorAvailable(int sensor) { if (sensor == 0) return true; else return isTelemetryFieldAvailable(abs(sensor) - 1); } bool isSensorUnit(int sensor, uint8_t unit) { if (sensor <= 0 || sensor > MAX_TELEMETRY_SENSORS ) { return true; } else { return g_model.telemetrySensors[sensor-1].unit == unit; } } bool isCellsSensor(int sensor) { return isSensorUnit(sensor, UNIT_CELLS); } bool isGPSSensor(int sensor) { return isSensorUnit(sensor, UNIT_GPS); } bool isAltSensor(int sensor) { return isSensorUnit(sensor, UNIT_DIST) || isSensorUnit(sensor, UNIT_FEET); } bool isVoltsSensor(int sensor) { return isSensorUnit(sensor, UNIT_VOLTS) || isSensorUnit(sensor, UNIT_CELLS); } bool isCurrentSensor(int sensor) { return isSensorUnit(sensor, UNIT_AMPS); } bool isTelemetryFieldAvailable(int index) { TelemetrySensor & sensor = g_model.telemetrySensors[index]; return sensor.isAvailable(); } bool isTelemetryFieldComparisonAvailable(int index) { if (!isTelemetryFieldAvailable(index)) return false; TelemetrySensor & sensor = g_model.telemetrySensors[index]; if (sensor.unit >= UNIT_DATETIME) return false; return true; } bool isChannelUsed(int channel) { for (int i=0; isrcRaw == 0) return false; if (md->destCh == channel) return true; if (md->destCh > channel) return false; } return false; } int getChannelsUsed() { int result = 0; int lastCh = -1; for (int i=0; isrcRaw == 0) return result; if (md->destCh != lastCh) { ++result; lastCh = md->destCh; } } return result; } bool isSourceAvailable(int source) { if (source < 0) return false; if (source>=MIXSRC_FIRST_INPUT && source<=MIXSRC_LAST_INPUT) { return isInputAvailable(source - MIXSRC_FIRST_INPUT); } #if defined(LUA_MODEL_SCRIPTS) if (source>=MIXSRC_FIRST_LUA && source<=MIXSRC_LAST_LUA) { div_t qr = div(source-MIXSRC_FIRST_LUA, MAX_SCRIPT_OUTPUTS); return (qr.rem=MIXSRC_FIRST_LUA && source<=MIXSRC_LAST_LUA) return false; #endif if (source>=MIXSRC_FIRST_POT && source<=MIXSRC_LAST_POT) { return IS_POT_SLIDER_AVAILABLE(POT1+source-MIXSRC_FIRST_POT); } #if defined(PCBSKY9X) && defined(REVX) if (source == MIXSRC_REa) { return false; } #endif #if defined(PCBX10) if ((source>=MIXSRC_S3 && source<=MIXSRC_S4) || (source>=MIXSRC_MOUSE1 && source<=MIXSRC_MOUSE2)) return false; #endif if (source>=MIXSRC_FIRST_SWITCH && source<=MIXSRC_LAST_SWITCH) { return SWITCH_EXISTS(source-MIXSRC_FIRST_SWITCH); } #if !defined(HELI) if (source>=MIXSRC_CYC1 && source<=MIXSRC_CYC3) return false; #endif if (source>=MIXSRC_FIRST_CH && source<=MIXSRC_LAST_CH) { return isChannelUsed(source-MIXSRC_FIRST_CH); } if (source>=MIXSRC_FIRST_LOGICAL_SWITCH && source<=MIXSRC_LAST_LOGICAL_SWITCH) { LogicalSwitchData * cs = lswAddress(source-MIXSRC_FIRST_LOGICAL_SWITCH); return (cs->func != LS_FUNC_NONE); } #if !defined(GVARS) if (source>=MIXSRC_GVAR1 && source<=MIXSRC_LAST_GVAR) return false; #endif if (source>=MIXSRC_FIRST_RESERVE && source<=MIXSRC_LAST_RESERVE) return false; if (source>=MIXSRC_FIRST_TELEM && source<=MIXSRC_LAST_TELEM) { div_t qr = div(source-MIXSRC_FIRST_TELEM, 3); if (qr.rem == 0) return isTelemetryFieldAvailable(qr.quot); else return isTelemetryFieldComparisonAvailable(qr.quot); } return true; } bool isSourceAvailableInGlobalFunctions(int source) { if (source>=MIXSRC_FIRST_TELEM && source<=MIXSRC_LAST_TELEM) { return false; } return isSourceAvailable(source); } bool isSourceAvailableInCustomSwitches(int source) { bool result = isSourceAvailable(source); #if defined(TELEMETRY_FRSKY) if (result && source>=MIXSRC_FIRST_TELEM && source<=MIXSRC_LAST_TELEM) { div_t qr = div(source-MIXSRC_FIRST_TELEM, 3); result = isTelemetryFieldComparisonAvailable(qr.quot); } #endif return result; } bool isInputSourceAvailable(int source) { if (source>=MIXSRC_FIRST_POT && source<=MIXSRC_LAST_POT) { return IS_POT_SLIDER_AVAILABLE(POT1+source-MIXSRC_FIRST_POT); } if (source>=MIXSRC_Rud && source<=MIXSRC_MAX) return true; if (source>=MIXSRC_FIRST_TRIM && source<=MIXSRC_LAST_TRIM) return true; if (source>=MIXSRC_FIRST_SWITCH && source<=MIXSRC_LAST_SWITCH) return SWITCH_EXISTS(source-MIXSRC_FIRST_SWITCH); if (source>=MIXSRC_FIRST_CH && source<=MIXSRC_LAST_CH) return true; if (source>=MIXSRC_FIRST_LOGICAL_SWITCH && source<=MIXSRC_LAST_LOGICAL_SWITCH) { LogicalSwitchData * cs = lswAddress(source-MIXSRC_SW1); return (cs->func != LS_FUNC_NONE); } if (source>=MIXSRC_FIRST_TRAINER && source<=MIXSRC_LAST_TRAINER) return true; if (source>=MIXSRC_FIRST_TELEM && source<=MIXSRC_LAST_TELEM) { div_t qr = div(source-MIXSRC_FIRST_TELEM, 3); return isTelemetryFieldAvailable(qr.quot) && isTelemetryFieldComparisonAvailable(qr.quot); } return false; } enum SwitchContext { LogicalSwitchesContext, ModelCustomFunctionsContext, GeneralCustomFunctionsContext, TimersContext, MixesContext }; bool isLogicalSwitchAvailable(int index) { LogicalSwitchData * lsw = lswAddress(index); return (lsw->func != LS_FUNC_NONE); } bool isSwitchAvailable(int swtch, SwitchContext context) { bool negative = false; if (swtch < 0) { if (swtch == -SWSRC_ON || swtch == -SWSRC_ONE) { return false; } negative = true; swtch = -swtch; } #if defined(PCBSKY9X) if (swtch >= SWSRC_FIRST_SWITCH && swtch <= SWSRC_LAST_SWITCH) { UNUSED(negative); return true; } #else if (swtch >= SWSRC_FIRST_SWITCH && swtch <= SWSRC_LAST_SWITCH) { div_t swinfo = switchInfo(swtch); if (!SWITCH_EXISTS(swinfo.quot)) { return false; } if (!IS_CONFIG_3POS(swinfo.quot)) { if (negative) { return false; } if (swinfo.rem == 1) { // mid position not available for 2POS switches return false; } } return true; } #endif #if NUM_XPOTS > 0 if (swtch >= SWSRC_FIRST_MULTIPOS_SWITCH && swtch <= SWSRC_LAST_MULTIPOS_SWITCH) { int index = (swtch - SWSRC_FIRST_MULTIPOS_SWITCH) / XPOTS_MULTIPOS_COUNT; if (IS_POT_MULTIPOS(POT1+index)) { StepsCalibData * calib = (StepsCalibData *) &g_eeGeneral.calib[POT1+index]; return (calib->count >= ((swtch - SWSRC_FIRST_MULTIPOS_SWITCH) % XPOTS_MULTIPOS_COUNT)); } else { return false; } } #endif #if defined(PCBSKY9X) && defined(REVX) if (swtch == SWSRC_REa) { return false; } #endif if (swtch >= SWSRC_FIRST_LOGICAL_SWITCH && swtch <= SWSRC_LAST_LOGICAL_SWITCH) { if (context == GeneralCustomFunctionsContext) { return false; } else if (context != LogicalSwitchesContext) { return isLogicalSwitchAvailable(swtch - SWSRC_FIRST_LOGICAL_SWITCH); } } if (context != ModelCustomFunctionsContext && context != GeneralCustomFunctionsContext && (swtch == SWSRC_ON || swtch == SWSRC_ONE)) { return false; } if (swtch >= SWSRC_FIRST_FLIGHT_MODE && swtch <= SWSRC_LAST_FLIGHT_MODE) { if (context == MixesContext || context == GeneralCustomFunctionsContext) { return false; } else { swtch -= SWSRC_FIRST_FLIGHT_MODE; if (swtch == 0) { return true; } FlightModeData * fm = flightModeAddress(swtch); return (fm->swtch != SWSRC_NONE); } } if (swtch >= SWSRC_FIRST_SENSOR && swtch <= SWSRC_LAST_SENSOR) { return isTelemetryFieldAvailable(swtch - SWSRC_FIRST_SENSOR); } return true; } bool isSwitchAvailableInLogicalSwitches(int swtch) { return isSwitchAvailable(swtch, LogicalSwitchesContext); } bool isSwitchAvailableInCustomFunctions(int swtch) { if (menuHandlers[menuLevel] == menuModelSpecialFunctions) return isSwitchAvailable(swtch, ModelCustomFunctionsContext); else return isSwitchAvailable(swtch, GeneralCustomFunctionsContext); } bool isSwitchAvailableInMixes(int swtch) { return isSwitchAvailable(swtch, MixesContext); } #if defined(COLORLCD) bool isSwitch2POSWarningStateAvailable(int state) { return (state != 2); // two pos switch - middle state not available } #endif // #if defined(COLORLCD) bool isSwitchAvailableInTimers(int swtch) { if (swtch >= 0) { if (swtch < TMRMODE_COUNT) return true; else swtch -= TMRMODE_COUNT-1; } else { if (swtch > -TMRMODE_COUNT) return false; else swtch += TMRMODE_COUNT-1; } return isSwitchAvailable(swtch, TimersContext); } bool isThrottleSourceAvailable(int source) { if (source >= THROTTLE_SOURCE_FIRST_POT && source < THROTTLE_SOURCE_FIRST_POT+NUM_POTS+NUM_SLIDERS && !IS_POT_SLIDER_AVAILABLE(POT1+source-THROTTLE_SOURCE_FIRST_POT)) return false; else return true; } bool isLogicalSwitchFunctionAvailable(int function) { return function != LS_FUNC_RANGE; } bool isAssignableFunctionAvailable(int function) { #if defined(OVERRIDE_CHANNEL_FUNCTION) || defined(GVARS) bool modelFunctions = (menuHandlers[menuLevel] == menuModelSpecialFunctions); #endif switch (function) { case FUNC_OVERRIDE_CHANNEL: #if defined(OVERRIDE_CHANNEL_FUNCTION) return modelFunctions; #else return false; #endif case FUNC_ADJUST_GVAR: #if defined(GVARS) return modelFunctions; #else return false; #endif #if !defined(HAPTIC) case FUNC_HAPTIC: #endif case FUNC_RESERVE4: #if !defined(DANGEROUS_MODULE_FUNCTIONS) case FUNC_RANGECHECK: case FUNC_BIND: #endif #if !defined(LUA) case FUNC_PLAY_SCRIPT: #endif case FUNC_RESERVE5: return false; default: return true; } } bool isSourceAvailableInGlobalResetSpecialFunction(int index) { if (index >= FUNC_RESET_PARAM_FIRST_TELEM) return false; else return isSourceAvailableInResetSpecialFunction(index); } bool isSourceAvailableInResetSpecialFunction(int index) { if (index >= FUNC_RESET_PARAM_FIRST_TELEM) { TelemetrySensor & telemetrySensor = g_model.telemetrySensors[index-FUNC_RESET_PARAM_FIRST_TELEM]; return telemetrySensor.isAvailable(); } #if TIMERS < 3 else if (index == FUNC_RESET_TIMER3) { return false; } #endif #if TIMERS < 2 else if (index == FUNC_RESET_TIMER2) { return false; } #endif else { return true; } } bool isModuleAvailable(int module) { #if defined(CROSSFIRE) && !defined(PCBFLAMENCO) if (module == MODULE_TYPE_CROSSFIRE && g_model.moduleData[INTERNAL_MODULE].rfProtocol != RF_PROTO_OFF) { return false; } #else if (module == MODULE_TYPE_CROSSFIRE) { return false; } #endif #if !defined(DSM2) if (module == MODULE_TYPE_DSM2) { return false; } #endif #if !defined(MULTIMODULE) if (module == MODULE_TYPE_MULTIMODULE) { return false; } #endif return true; } bool isRfProtocolAvailable(int protocol) { #if defined(CROSSFIRE) if (protocol != RF_PROTO_OFF && g_model.moduleData[EXTERNAL_MODULE].type == MODULE_TYPE_CROSSFIRE) { return false; } #endif #if defined(MODULE_D16_EU_ONLY_SUPPORT) if (protocol == RF_PROTO_D8) { return false; } #endif return true; } #if defined(CPUARM) bool isTelemetryProtocolAvailable(int protocol) { #if defined(PCBTARANIS) if (protocol == PROTOCOL_FRSKY_D_SECONDARY && g_eeGeneral.serial2Mode != UART_MODE_TELEMETRY) { return false; } #endif if (protocol== PROTOCOL_PULSES_CROSSFIRE) { return false; } #if !defined(MULTIMODULE) if (protocol == PROTOCOL_SPEKTRUM || protocol == PROTOCOL_FLYSKY_IBUS || protocol == PROTOCOL_MULTIMODULE) { return false; } #endif #if defined(PCBHORUS) if (protocol == PROTOCOL_FRSKY_D_SECONDARY) { return false; } #endif return true; } #endif #if defined(PCBHORUS) bool isTrainerModeAvailable(int mode) { return true; } #elif defined(PCBTARANIS) bool isTrainerModeAvailable(int mode) { if (IS_EXTERNAL_MODULE_PRESENT() && (mode == TRAINER_MODE_MASTER_SBUS_EXTERNAL_MODULE || mode == TRAINER_MODE_MASTER_CPPM_EXTERNAL_MODULE)) return false; else return true; } #endif bool modelHasNotes() { char filename[sizeof(MODELS_PATH)+1+sizeof(g_model.header.name)+sizeof(TEXT_EXT)] = MODELS_PATH "/"; char *buf = strcat_currentmodelname(&filename[sizeof(MODELS_PATH)]); strcpy(buf, TEXT_EXT); if (isFileAvailable(filename)) { return true; } #if !defined(EEPROM) buf = strAppendFilename(&filename[sizeof(MODELS_PATH)], g_eeGeneral.currModelFilename, LEN_MODEL_FILENAME); strcpy(buf, TEXT_EXT); if (isFileAvailable(filename)) { return true; } #endif return false; } int getFirstAvailable(int min, int max, IsValueAvailable isValueAvailable) { int retval = 0; for (int i = min; i <= max; i++) { if (isValueAvailable(i)) { retval = i; break; } } return retval; } #if defined(MULTIMODULE) // Third row is number of subtypes -1 (max valid subtype) #define NO_SUBTYPE nullptr // Table is designed to be shared with companion multi.cpp // The subtype and options strings are only referenced here, so // define them here to avoid duplication in all language files // Also since these strings are ARM only and likely stay ARM only // we don't need the special eeprom/flash string handling, just define them as // local strings const pm_char STR_SUBTYPE_FLYSKY[] PROGMEM = "\004""Std\0""V9x9""V6x6""V912""CX20"; const pm_char STR_SUBTYPE_AFHDS2A[] PROGMEM = "\010""PWM,IBUS""PPM,IBUS""PWM,SBUS""PPM,SBUS"; const pm_char STR_SUBTYPE_FRSKY[] PROGMEM = "\007""D16\0 ""D8\0 ""D16 8ch""V8\0 ""LBT(EU)""LBT 8ch"; const pm_char STR_SUBTYPE_HISKY[] PROGMEM = "\005""HiSky""HK310"; const pm_char STR_SUBTYPE_DSM[] PROGMEM = "\006""2 22ms""2 11ms""X 22ms""X 11ms"; const pm_char STR_SUBTYPE_YD717[] PROGMEM = "\007""YD717\0 ""SKYWLKR""Syma X2""XINXUN\0""NIHUI\0 "; const pm_char STR_SUBTYPE_SYMAX[] PROGMEM = "\003""Std""5c\0"; const pm_char STR_SUBTYPE_SLT[] PROGMEM = "\005""SLT\0 ""Vista"; const pm_char STR_SUBTYPE_CX10[] PROGMEM = "\007""Green\0 ""Blue\0 ""DM007\0 ""-\0 ""JC3015a""JC3015b""MK33041""Q242\0 "; const pm_char STR_SUBTYPE_CG023[] PROGMEM = "\005""CG023""YD829""H8 3d"; const pm_char STR_SUBTYPE_KN[] PROGMEM = "\006""WLtoys""FeiLun"; const pm_char STR_SUBTYPE_MT99[] PROGMEM = "\005""MT99\0""H7\0 ""YZ\0 ""LS\0 ""FY805"; const pm_char STR_SUBTYPE_MJXQ[] PROGMEM = "\005""WLH08""X600\0""X800\0""H26D\0""E010\0""H26WH"; const pm_char STR_SUBTYPE_HONTAI[] PROGMEM = "\007""Std\0 ""JJRC X1""X5C1cln"; const pm_char STR_SUBTYPE_Q2X2[] PROGMEM = "\004""Q222""Q242""Q282"; const pm_char STR_SUBTYPE_Q303[] PROGMEM = "\006""Q303\0 ""CX35\0 ""CX10D\0""CX10WD"; const pm_char STR_SUBTYPE_WK2x01[] PROGMEM = "\006""WK2801""WK2401""W6_5_1""W6_6_1""W6_Hel""W6_HeI"; const pm_char STR_SUBTYPE_V2X2[] PROGMEM = "\006""V2x2\0 ""JXD506"; const pm_char STR_SUBTYPE_BAYANG[] PROGMEM = "\006""Bayang""H8S3D"; const pm_char STR_SUBTYPE_FY326[] PROGMEM = "\005""FY326""FY319"; const mm_protocol_definition multi_protocols[] = { { MM_RF_PROTO_FLYSKY, STR_SUBTYPE_FLYSKY, 4, nullptr }, { MM_RF_PROTO_HUBSAN, NO_SUBTYPE, 0, STR_MULTI_VIDFREQ }, { MM_RF_PROTO_FRSKY, STR_SUBTYPE_FRSKY, 5, STR_MULTI_RFTUNE }, { MM_RF_PROTO_HISKY, STR_SUBTYPE_HISKY, 1, nullptr }, { MM_RF_PROTO_V2X2, STR_SUBTYPE_V2X2, 1, nullptr }, { MM_RF_PROTO_DSM2, STR_SUBTYPE_DSM, 3, nullptr }, { MM_RF_PROTO_YD717, STR_SUBTYPE_YD717, 4, nullptr }, { MM_RF_PROTO_KN, STR_SUBTYPE_KN, 1, nullptr }, { MM_RF_PROTO_SYMAX, STR_SUBTYPE_SYMAX, 1, nullptr }, { MM_RF_PROTO_SLT, STR_SUBTYPE_SLT, 1, nullptr }, { MM_RF_PROTO_CX10, STR_SUBTYPE_CX10, 7, nullptr }, { MM_RF_PROTO_CG023, STR_SUBTYPE_CG023, 2, nullptr }, { MM_RF_PROTO_BAYANG, STR_SUBTYPE_BAYANG, 1, STR_MULTI_TELEMETRY }, { MM_RF_PROTO_MT99XX, STR_SUBTYPE_MT99, 4, nullptr }, { MM_RF_PROTO_MJXQ, STR_SUBTYPE_MJXQ, 5, nullptr }, { MM_RF_PROTO_FY326, STR_SUBTYPE_FY326, 1, nullptr }, { MM_RF_PROTO_SFHSS, NO_SUBTYPE, 0, STR_MULTI_RFTUNE }, { MM_RF_PROTO_HONTAI, STR_SUBTYPE_HONTAI, 2, nullptr }, { MM_RF_PROTO_OLRS, NO_SUBTYPE, 0, STR_MULTI_RFPOWER }, { MM_RF_PROTO_FS_AFHDS2A, STR_SUBTYPE_AFHDS2A, 3, STR_MULTI_SERVOFREQ }, { MM_RF_PROTO_Q2X2, STR_SUBTYPE_Q2X2, 2, nullptr }, { MM_RF_PROTO_WK_2X01, STR_SUBTYPE_WK2x01, 5, nullptr }, { MM_RF_PROTO_Q303, STR_SUBTYPE_Q303, 3, nullptr }, { MM_RF_CUSTOM_SELECTED, NO_SUBTYPE, 7, STR_MULTI_OPTION }, //Sential and default for protocols not listed above (MM_RF_CUSTOM is 0xff() { 0xfe, NO_SUBTYPE, 0, nullptr } }; #undef NO_SUBTYPE const mm_protocol_definition *getMultiProtocolDefinition (uint8_t protocol) { const mm_protocol_definition *pdef; for (pdef = multi_protocols; pdef->protocol != 0xfe; pdef++) { if (pdef->protocol == protocol) return pdef; } // Return the empty last protocol return pdef; } #endif void editStickHardwareSettings(coord_t x, coord_t y, int idx, event_t event, LcdFlags flags) { lcdDrawTextAtIndex(INDENT_WIDTH, y, STR_VSRCRAW, idx+1, 0); if (ZEXIST(g_eeGeneral.anaNames[idx]) || (flags && s_editMode > 0)) editName(x, y, g_eeGeneral.anaNames[idx], LEN_ANA_NAME, event, flags); else lcdDrawMMM(x, y, flags); }