#include #include "er9xeeprom.h" #include "helpers.h" #include RawSwitch er9xToSwitch(int8_t sw) { uint8_t swa = abs(sw); if (swa == 0) return RawSwitch(SWITCH_TYPE_NONE); else if (swa <= 9) return RawSwitch(SWITCH_TYPE_SWITCH, sw); else if (swa <= 21) return RawSwitch(SWITCH_TYPE_VIRTUAL, sw > 0 ? sw-9 : sw+9); else if (sw == 22) return RawSwitch(SWITCH_TYPE_ON); else if (sw == -22) return RawSwitch(SWITCH_TYPE_OFF); else if (swa <= 22+9) return RawSwitch(SWITCH_TYPE_SWITCH, sw > 0 ? sw-22 : sw+22); else return RawSwitch(SWITCH_TYPE_VIRTUAL, sw > 0 ? sw-22-9 : sw+22+9); } t_Er9xTrainerMix::t_Er9xTrainerMix() { memset(this, 0, sizeof(t_Er9xTrainerMix)); } t_Er9xTrainerMix::operator TrainerMix() { TrainerMix c9x; c9x.src = srcChn; c9x.swtch = er9xToSwitch(swtch); c9x.weight = (25 * studWeight) / 8; c9x.mode = mode; return c9x; } t_Er9xTrainerData::t_Er9xTrainerData() { memset(this, 0, sizeof(t_Er9xTrainerData)); } t_Er9xTrainerData::operator TrainerData () { TrainerData c9x; for (int i=0; i125) { int gvar; if (weight>0) { gvar=weight-125; } else { gvar=weight+131; } gvar+=10000; c9x.weight=gvar; } else { c9x.weight = weight; } if (abs(sOffset)>125) { int gvar; if (sOffset>0) { gvar=sOffset-125; } else { gvar=sOffset+131; } gvar+=10000; c9x.sOffset=gvar; } else { c9x.sOffset=sOffset; } c9x.swtch = er9xToSwitch(swtch); if (srcRaw == 0) { c9x.srcRaw = RawSource(SOURCE_TYPE_NONE); } else if (srcRaw <= 7) { c9x.srcRaw = RawSource(SOURCE_TYPE_STICK, srcRaw-1); } else if (srcRaw == 8) { c9x.srcRaw = RawSource(SOURCE_TYPE_MAX); } else if (srcRaw == 9) { if (swtch < 0) { c9x.srcRaw = RawSource(SOURCE_TYPE_SWITCH, swtch < -3 ? -swtch-3 : -swtch); c9x.weight = -weight; } else if (swtch > 0) { c9x.srcRaw = RawSource(SOURCE_TYPE_SWITCH, swtch > 3 ? swtch-3 : swtch); } else { c9x.srcRaw = RawSource(SOURCE_TYPE_MAX); } if (mltpx != MLTPX_REP) c9x.swtch = RawSwitch(SWITCH_TYPE_NONE); } else if (srcRaw <= 12) { c9x.srcRaw = RawSource(SOURCE_TYPE_CYC, srcRaw-10); } else if (srcRaw <= 20) { c9x.srcRaw = RawSource(SOURCE_TYPE_PPM, srcRaw-13); } else if (srcRaw <=37) { c9x.srcRaw = RawSource(SOURCE_TYPE_CH, srcRaw-21); } else { c9x.srcRaw = RawSource(SOURCE_TYPE_GVAR, srcRaw-38); } if (differential==1) { c9x.curve.type = CurveReference::CURVE_REF_DIFF; c9x.curve.value = differential; } else if (curve > 6) { c9x.curve.type = CurveReference::CURVE_REF_CUSTOM; c9x.curve.value = curve - 6; } else if (curve > 0) { c9x.curve.type = CurveReference::CURVE_REF_FUNC; c9x.curve.value = curve; } // c9x.lateOffset=lateOffset; c9x.delayUp = delayUp; c9x.delayDown = delayDown; c9x.speedUp = speedUp; c9x.speedDown = speedDown; c9x.carryTrim = carryTrim; c9x.mltpx = (MltpxValue)mltpx; c9x.mixWarn = mixWarn; // c9x.enableFmTrim=enableFmTrim; return c9x; } RawSource er9xToSource(int8_t value) { if (value == 0) { return RawSource(SOURCE_TYPE_NONE); } else if (value <= 7) { return RawSource(SOURCE_TYPE_STICK, value - 1); } else if (value == 8) { return RawSource(SOURCE_TYPE_MAX); } else if (value == 9) { return RawSource(SOURCE_TYPE_MAX); } else if (value <= 12) { return RawSource(SOURCE_TYPE_CYC, value-10); } else if (value <= 20) { return RawSource(SOURCE_TYPE_PPM, value-13); } else if (value <= 36) { return RawSource(SOURCE_TYPE_CH, value-21); } else { return RawSource(SOURCE_TYPE_TELEMETRY, value-36); } } Er9xLogicalSwitchData::operator LogicalSwitchData () { LogicalSwitchData c9x; c9x.func = func; c9x.val1 = v1; c9x.val2 = v2; if ((c9x.func >= LS_FN_VPOS && c9x.func <= LS_FN_ANEG) || c9x.func >= LS_FN_EQUAL) { c9x.val1 = er9xToSource(v1).toValue(); } if (c9x.func >= LS_FN_EQUAL) { c9x.val2 = er9xToSource(v2).toValue(); } if (c9x.func >= LS_FN_AND && c9x.func <= LS_FN_XOR) { c9x.val1 = er9xToSwitch(v1).toValue(); c9x.val2 = er9xToSwitch(v2).toValue(); } return c9x; } t_Er9xSafetySwData::t_Er9xSafetySwData() { memset(this, 0, sizeof(t_Er9xSafetySwData)); } t_Er9xFrSkyChannelData::t_Er9xFrSkyChannelData() { memset(this, 0, sizeof(t_Er9xFrSkyChannelData)); } t_Er9xFrSkyChannelData::operator FrSkyChannelData () { FrSkyChannelData c9x; c9x.ratio = ratio; c9x.alarms[0].value = alarms_value[0]; c9x.alarms[0].level = alarms_level & 3; c9x.alarms[0].greater = alarms_greater & 1; c9x.alarms[1].value = alarms_value[1]; c9x.alarms[1].level = (alarms_level >> 2) & 3; c9x.alarms[1].greater = (alarms_greater >> 1) & 1; if (type==2) { c9x.type = 0; c9x.multiplier=1; } else { c9x.type = type; } return c9x; } t_Er9xFrSkyData::t_Er9xFrSkyData() { memset(this, 0, sizeof(t_Er9xFrSkyData)); } t_Er9xFrSkyData::operator FrSkyData () { FrSkyData c9x; c9x.channels[0] = channels[0]; c9x.channels[1] = channels[1]; return c9x; } RawSwitch getEr9xTimerMode(int mode) { /* if (mode <= -33) return TimerMode(TMRMODE_FIRST_NEG_SWITCH+(mode+33)); else if (mode <= -1) return TimerMode(TMRMODE_FIRST_NEG_SWITCH+(mode+1)); else if (mode < 16) return TimerMode(mode); else if (mode < 16+21) return TimerMode(TMRMODE_FIRST_SWITCH+(mode-16)); else return TimerMode(TMRMODE_FIRST_SWITCH+(mode-16-21)); */ return RawSwitch(); } t_Er9xModelData::operator ModelData () { ModelData c9x; c9x.used = true; c9x.modelVoice = modelVoice; getEEPROMString(c9x.name, name, sizeof(name)); c9x.timers[0].mode = getEr9xTimerMode(tmrMode); c9x.timers[0].dir = tmrDir; c9x.timers[0].val = tmrVal; switch(protocol) { case 1: c9x.moduleData[0].protocol = PXX_DJT; break; case 2: c9x.moduleData[0].protocol = DSM2; break; case 3: c9x.moduleData[0].protocol = PPM16; break; default: c9x.moduleData[0].protocol = PPM; break; } c9x.traineron= traineron; // c9x.t2throttle = t2throttle; c9x.moduleData[0].ppmFrameLength=ppmFrameLength; c9x.moduleData[0].channelsCount = 8 + 2 * ppmNCH; c9x.thrTrim = thrTrim; c9x.thrExpo = thrExpo; c9x.trimInc = trimInc-2; c9x.moduleData[0].ppmDelay = 300 + 50 * ppmDelay; c9x.funcSw[0].func = FuncInstantTrim; if (trimSw) { c9x.funcSw[0].swtch = er9xToSwitch(trimSw); } c9x.beepANACenter = beepANACenter; c9x.moduleData[0].ppmPulsePol = pulsePol; c9x.extendedLimits = extendedLimits; c9x.swashRingData.invertELE = swashInvertELE; c9x.swashRingData.invertAIL = swashInvertAIL; c9x.swashRingData.invertCOL = swashInvertCOL; c9x.swashRingData.type = swashType; c9x.swashRingData.collectiveSource = er9xToSource(swashCollectiveSource); c9x.swashRingData.value = swashRingValue; for (int i=0; i