WiP PoC AFHDS3 internal module
This commit is contained in:
committed by
Raphael Coeffic
parent
5132e11d41
commit
bb6c6d6e2d
@@ -784,26 +784,17 @@ inline void resetAccessAuthenticationCount()
|
||||
#endif
|
||||
}
|
||||
|
||||
inline void resetAfhds3Options(uint8_t moduleIdx)
|
||||
inline void resetAfhdsOptions(uint8_t moduleIdx)
|
||||
{
|
||||
auto & data = g_model.moduleData[moduleIdx];
|
||||
//data.rfProtocol = 0;
|
||||
data.subType = 0;
|
||||
#if defined(AFHDS3)
|
||||
data.afhds3.bindPower = 0;
|
||||
data.afhds3.runPower = 0;
|
||||
data.afhds3.emi = 0;
|
||||
data.subType = FLYSKY_SUBTYPE_AFHDS3;
|
||||
data.afhds3.emi = 2; // FCC
|
||||
data.afhds3.telemetry = 1;
|
||||
data.afhds3.rx_freq[0] = 50;
|
||||
data.afhds3.rx_freq[1] = 0;
|
||||
data.afhds3.failsafeTimeout = 1000;
|
||||
data.channelsCount = 14 - 8;
|
||||
data.failsafeMode = 1;
|
||||
//" PWM+i"" PWM+s"" PPM+i"" PPM+s"
|
||||
data.subType = 0;
|
||||
for (uint8_t channel = 0; channel < MAX_OUTPUT_CHANNELS; channel++) {
|
||||
g_model.failsafeChannels[channel] = 0;
|
||||
}
|
||||
data.afhds3.phyMode = 0;
|
||||
#elif defined(AFHDS2A)
|
||||
data.subType = FLYSKY_SUBTYPE_AFHDS2A;
|
||||
data.flysky.setDefault();
|
||||
#endif
|
||||
}
|
||||
|
||||
@@ -819,8 +810,7 @@ inline void setModuleType(uint8_t moduleIdx, uint8_t moduleType)
|
||||
else if (moduleData.type == MODULE_TYPE_PPM)
|
||||
setDefaultPpmFrameLength(moduleIdx);
|
||||
else if (moduleData.type == MODULE_TYPE_FLYSKY) {
|
||||
// TODO: what if AFHDS2A
|
||||
resetAfhds3Options(moduleIdx);
|
||||
resetAfhdsOptions(moduleIdx);
|
||||
}
|
||||
else
|
||||
resetAccessAuthenticationCount();
|
||||
|
||||
Reference in New Issue
Block a user