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:
parent
d9596a1ef4
commit
db9723e4be
2 changed files with 6 additions and 3 deletions
|
@ -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
|
||||
}
|
||||
|
|
|
@ -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;
|
||||
}
|
||||
|
||||
|
|
Loading…
Add table
Add a link
Reference in a new issue