Fixed telemetry

This commit is contained in:
Raphael Coeffic
2021-09-19 16:17:47 +02:00
parent 78d8d976b4
commit b0147a43d0
4 changed files with 67 additions and 47 deletions
+3 -2
View File
@@ -39,7 +39,8 @@ enum DEBUG_RF_FRAME_PRINT_E {
BOTH_FRAME_PRINT = 3
};
#define DEBUG_RF_FRAME_PRINT FRAME_PRINT_OFF
//#define DEBUG_RF_FRAME_PRINT FRAME_PRINT_OFF
#define DEBUG_RF_FRAME_PRINT BOTH_FRAME_PRINT
#define FLYSKY_MODULE_TIMEOUT 155 /* ms */
#define FLYSKY_PERIOD 4 /*ms*/
#define NUM_OF_NV14_CHANNELS (14)
@@ -399,7 +400,7 @@ inline void debugFrame(const uint8_t* rxBuffer, uint8_t rxBufferCount)
inline void parseResponse()
{
const afhds2Resp* resp =
afhds2Resp* resp =
reinterpret_cast<afhds2Resp*>(intmodulePulsesData.flysky.telemetry);
uint8_t dataLen = intmodulePulsesData.flysky.telemetry_index;