Move AFHDS3 to new module interface

This commit is contained in:
Raphael Coeffic
2022-08-11 12:15:46 +02:00
committed by Raphael Coeffic
parent 1a918bf072
commit db73e4cd87
5 changed files with 205 additions and 33 deletions
+16 -3
View File
@@ -218,7 +218,7 @@ void processTelemetryData(uint8_t data)
#if defined(AFHDS3)
if (telemetryProtocol == PROTOCOL_TELEMETRY_AFHDS3) {
afhds3::processTelemetryData(EXTERNAL_MODULE, data, telemetryRxBuffer, telemetryRxBufferCount, TELEMETRY_RX_PACKET_SIZE);
afhds3::processTelemetryData(data, EXTERNAL_MODULE);
return;
}
#endif
@@ -312,7 +312,7 @@ static void pollIntCrossfire()
}
#endif
#if defined(PCBNV14)
#if defined(INTERNAL_MODULE_AFHDS2A)
static void processFlySkyTelemetryData(uint8_t data, uint8_t idx)
{
(void)idx;
@@ -325,6 +325,13 @@ static void pollIntAFHDS2A()
}
#endif
#if defined(INTERNAL_MODULE_AFHDS3)
static void pollIntAFHDS3()
{
pollIntTelemetry(afhds3::processTelemetryData);
}
#endif
static void pollExtTelemetry()
{
uint8_t data;
@@ -377,12 +384,18 @@ void telemetryWakeup()
pollIntCrossfire();
}
#endif
#if defined(PCBNV14)
#if defined(INTERNAL_MODULE_AFHDS2A)
//! moduleUpdateActive(INTERNAL_MODULE) &&
if (isModuleAFHDS2A(INTERNAL_MODULE)) {
pollIntAFHDS2A();
}
#endif
#if defined(INTERNAL_MODULE_AFHDS3)
//! moduleUpdateActive(INTERNAL_MODULE) &&
if (isModuleAFHDS3(INTERNAL_MODULE)) {
pollIntAFHDS3();
}
#endif
// Poll external / S.PORT telemetry
// TODO: how to switch this OFF ???