}
}
-bool IP_Pkt_Check(size_t len, const void *data, size_t *ofs_out, int AF, const void *Src, const void *Dst, uint8_t proto)
+bool IP_Pkt_Check(size_t len, const void *data, size_t *ofs_out, size_t *len_out, int AF, const void *Src, const void *Dst, uint8_t proto)
{
size_t ofs;
if( AF == 4 ) {
TEST_ASSERT_REL(IP_Checksum(IP_CHECKSUM_START, sizeof(hdr), &hdr), ==, 0);
TEST_ASSERT_REL(ntohs(hdr.TotalLength), <=, len - ofs);
+ TEST_ASSERT_REL(ntohs(hdr.TotalLength), >, (hdr.VerLen & 0xF) * 4);
TEST_ASSERT_REL(ntohs(hdr.FragmentInfo), ==, 0);
TEST_ASSERT_REL(hdr.TTL, >, 1); // >1 because there's no intervening hops
if(Src) TEST_ASSERT( memcmp(hdr.SrcAddr, Src, 4) == 0 );
if(Dst) TEST_ASSERT( memcmp(hdr.DstAddr, Dst, 4) == 0 );
-
+
+ *len_out = ntohs(hdr.TotalLength) - sizeof(hdr);
*ofs_out = ofs + (hdr.VerLen & 0xF) * 4;
return true;
}