|
|
|
@ -140,9 +140,134 @@ typedef struct TCPCache_ {
|
|
|
|
|
(p)->tcpc.ts2 = 0; \
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
inline uint16_t TCPCalculateChecksum(uint16_t *, uint16_t *, uint16_t);
|
|
|
|
|
inline uint16_t TCPV6CalculateChecksum(uint16_t *, uint16_t *, uint16_t);
|
|
|
|
|
void DecodeTCPRegisterTests(void);
|
|
|
|
|
|
|
|
|
|
/** -------- Inline functions ------- */
|
|
|
|
|
static inline uint16_t TCPCalculateChecksum(uint16_t *, uint16_t *, uint16_t);
|
|
|
|
|
static inline uint16_t TCPV6CalculateChecksum(uint16_t *, uint16_t *, uint16_t);
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* \brief Calculates the checksum for the TCP packet
|
|
|
|
|
*
|
|
|
|
|
* \param shdr Pointer to source address field from the IP packet. Used as a
|
|
|
|
|
* part of the psuedoheader for computing the checksum
|
|
|
|
|
* \param pkt Pointer to the start of the TCP packet
|
|
|
|
|
* \param hlen Total length of the TCP packet(header + payload)
|
|
|
|
|
*
|
|
|
|
|
* \retval csum Checksum for the TCP packet
|
|
|
|
|
*/
|
|
|
|
|
static inline uint16_t TCPCalculateChecksum(uint16_t *shdr, uint16_t *pkt,
|
|
|
|
|
uint16_t tlen)
|
|
|
|
|
{
|
|
|
|
|
uint16_t pad = 0;
|
|
|
|
|
uint32_t csum = shdr[0];
|
|
|
|
|
|
|
|
|
|
csum += shdr[1] + shdr[2] + shdr[3] + htons(6 + tlen);
|
|
|
|
|
|
|
|
|
|
csum += pkt[0] + pkt[1] + pkt[2] + pkt[3] + pkt[4] + pkt[5] + pkt[6] +
|
|
|
|
|
pkt[7] + pkt[9];
|
|
|
|
|
|
|
|
|
|
tlen -= 20;
|
|
|
|
|
pkt += 10;
|
|
|
|
|
|
|
|
|
|
while (tlen >= 32) {
|
|
|
|
|
csum += pkt[0] + pkt[1] + pkt[2] + pkt[3] + pkt[4] + pkt[5] + pkt[6] +
|
|
|
|
|
pkt[7] + pkt[8] + pkt[9] + pkt[10] + pkt[11] + pkt[12] + pkt[13] +
|
|
|
|
|
pkt[14] + pkt[15];
|
|
|
|
|
tlen -= 32;
|
|
|
|
|
pkt += 16;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
while(tlen >= 8) {
|
|
|
|
|
csum += pkt[0] + pkt[1] + pkt[2] + pkt[3];
|
|
|
|
|
tlen -= 8;
|
|
|
|
|
pkt += 4;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
while(tlen >= 4) {
|
|
|
|
|
csum += pkt[0] + pkt[1];
|
|
|
|
|
tlen -= 4;
|
|
|
|
|
pkt += 2;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
while (tlen > 1) {
|
|
|
|
|
csum += pkt[0];
|
|
|
|
|
pkt += 1;
|
|
|
|
|
tlen -= 2;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (tlen == 1) {
|
|
|
|
|
*(uint8_t *)(&pad) = (*(uint8_t *)pkt);
|
|
|
|
|
csum += pad;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
csum = (csum >> 16) + (csum & 0x0000FFFF);
|
|
|
|
|
|
|
|
|
|
return (uint16_t) ~csum;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* \brief Calculates the checksum for the TCP packet
|
|
|
|
|
*
|
|
|
|
|
* \param shdr Pointer to source address field from the IPV6 packet. Used as a
|
|
|
|
|
* part of the psuedoheader for computing the checksum
|
|
|
|
|
* \param pkt Pointer to the start of the TCP packet
|
|
|
|
|
* \param tlen Total length of the TCP packet(header + payload)
|
|
|
|
|
*
|
|
|
|
|
* \retval csum Checksum for the TCP packet
|
|
|
|
|
*/
|
|
|
|
|
static inline uint16_t TCPV6CalculateChecksum(uint16_t *shdr, uint16_t *pkt,
|
|
|
|
|
uint16_t tlen)
|
|
|
|
|
{
|
|
|
|
|
uint16_t pad = 0;
|
|
|
|
|
uint32_t csum = shdr[0];
|
|
|
|
|
|
|
|
|
|
csum += shdr[1] + shdr[2] + shdr[3] + shdr[4] + shdr[5] + shdr[6] +
|
|
|
|
|
shdr[7] + shdr[8] + shdr[9] + shdr[10] + shdr[11] + shdr[12] +
|
|
|
|
|
shdr[13] + shdr[14] + shdr[15] + htons(6 + tlen);
|
|
|
|
|
|
|
|
|
|
csum += pkt[0] + pkt[1] + pkt[2] + pkt[3] + pkt[4] + pkt[5] + pkt[6] +
|
|
|
|
|
pkt[7] + pkt[9];
|
|
|
|
|
|
|
|
|
|
tlen -= 20;
|
|
|
|
|
pkt += 10;
|
|
|
|
|
|
|
|
|
|
while (tlen >= 32) {
|
|
|
|
|
csum += pkt[0] + pkt[1] + pkt[2] + pkt[3] + pkt[4] + pkt[5] + pkt[6] +
|
|
|
|
|
pkt[7] + pkt[8] + pkt[9] + pkt[10] + pkt[11] + pkt[12] + pkt[13] +
|
|
|
|
|
pkt[14] + pkt[15];
|
|
|
|
|
tlen -= 32;
|
|
|
|
|
pkt += 16;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
while(tlen >= 8) {
|
|
|
|
|
csum += pkt[0] + pkt[1] + pkt[2] + pkt[3];
|
|
|
|
|
tlen -= 8;
|
|
|
|
|
pkt += 4;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
while(tlen >= 4) {
|
|
|
|
|
csum += pkt[0] + pkt[1];
|
|
|
|
|
tlen -= 4;
|
|
|
|
|
pkt += 2;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
while (tlen > 1) {
|
|
|
|
|
csum += pkt[0];
|
|
|
|
|
pkt += 1;
|
|
|
|
|
tlen -= 2;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (tlen == 1) {
|
|
|
|
|
*(uint8_t *)(&pad) = (*(uint8_t *)pkt);
|
|
|
|
|
csum += pad;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
csum = (csum >> 16) + (csum & 0x0000FFFF);
|
|
|
|
|
|
|
|
|
|
return (uint16_t) ~csum;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#endif /* __DECODE_TCP_H__ */
|
|
|
|
|
|
|
|
|
|