WiP PoC AFHDS3 internal module

This commit is contained in:
Raphael Coeffic
2022-08-11 12:15:46 +02:00
committed by Raphael Coeffic
parent 5132e11d41
commit bb6c6d6e2d
30 changed files with 1313 additions and 990 deletions
+8 -18
View File
@@ -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();