Add some packet sanity checks

This commit is contained in:
Philip Heron 2018-07-04 10:41:03 +01:00
parent 3310c6f0c3
commit 035f920f5c
1 changed files with 14 additions and 0 deletions

14
ssdv.c
View File

@ -1313,6 +1313,13 @@ char ssdv_dec_feed(ssdv_t *s, uint8_t *packet)
/* Is this not the packet we expected? */ /* Is this not the packet we expected? */
if(packet_id != s->packet_id) if(packet_id != s->packet_id)
{ {
if(packet_id < s->packet_id)
{
/* The decoder can only accept packets in the correct order */
fprintf(stderr, "Packets are not in order. %i > %i\n", s->packet_id - 1, packet_id);
return(SSDV_FEED_ME);
}
/* One or more packets have been lost! */ /* One or more packets have been lost! */
fprintf(stderr, "Gap detected between packets %i and %i\n", s->packet_id - 1, packet_id); fprintf(stderr, "Gap detected between packets %i and %i\n", s->packet_id - 1, packet_id);
@ -1343,6 +1350,13 @@ char ssdv_dec_feed(ssdv_t *s, uint8_t *packet)
/* The first MCU in a packet is byte aligned, /* The first MCU in a packet is byte aligned,
* any old bits should be dropped. */ * any old bits should be dropped. */
s->workbits = s->worklen = 0; s->workbits = s->worklen = 0;
/* Abandon the packet if the MCU index is not what it should be. */
if(s->mcu_id != s->packet_mcu_id)
{
fprintf(stderr, "Unexpected MCU ID in packet %d.\n", packet_id);
return(SSDV_FEED_ME);
}
} }
b = packet[SSDV_PKT_SIZE_HEADER + i]; b = packet[SSDV_PKT_SIZE_HEADER + i];