1
0
Fork 0
mirror of https://github.com/iNavFlight/inav.git synced 2025-07-24 00:35:34 +03:00

More permissive parsing.

This commit is contained in:
Marcelo Bezerra 2024-09-05 19:19:59 +02:00
parent d9596a1ef4
commit db9723e4be
2 changed files with 6 additions and 3 deletions

View file

@ -4127,7 +4127,7 @@ static mspResult_e mspProcessSensorCommand(uint16_t cmdMSP, sbuf_t *src)
#if (defined(USE_HEADTRACKER) && defined(USE_HEADTRACKER_MSP))
case MSP2_SENSOR_HEADTRACKER:
mspHeadTrackerReceiverNewData(sbufPtr(src), dataSize);
mspHeadTrackerReceiverNewData(sbufPtr(src), sbufBytesRemaining(src));
break;
#endif
}

View file

@ -54,9 +54,12 @@ void mspHeadTrackerInit(void)
void mspHeadTrackerReceiverNewData(uint8_t *data, int dataSize)
{
if(dataSize != sizeof(headtrackerMspMessage_t)) {
if(dataSize >= sizeof(headtrackerMspMessage_t)) {
SD(fprintf(stderr, "[headTracker]: invalid data size %d\n", dataSize));
DEBUG_SET(DEBUG_HEADTRACKING, 7, 1);
static int errorCount = 0;
DEBUG_SET(DEBUG_HEADTRACKING, 7, errorCount++);
DEBUG_SET(DEBUG_HEADTRACKING, 5, (sizeof(headtrackerMspMessage_t)));
DEBUG_SET(DEBUG_HEADTRACKING, 6, dataSize);
return;
}