校验和计算

#include <stdlib.h>
#include <stdio.h>


typedef unsigned short int uint16_t;
typedef unsigned int uint32_t;
typedef unsigned char uint8_t;


struct TestSpeedReq {
    uint32_t magic;
    uint16_t pkt_len;
    uint16_t ver;
    uint16_t crc; 
    uint8_t type;
    uint32_t seq;
};


static inline uint32_t __buffer_raw_cksum(const void *buf, uint32_t len, uint32_t sum)
{
/* workaround gcc strict-aliasing warning */
uintptr_t ptr = (uintptr_t)buf;
const uint16_t *u16 = (const uint16_t *)ptr;


while (len >= (sizeof(*u16) * 4)) {
sum += u16[0];
sum += u16[1];
sum += u16[2];
sum += u16[3];
len -= sizeof(*u16) * 4;
u16 += 4;
}
while (len >= sizeof(*u16)) {
sum += *u16;
len -= sizeof(*u16);
u16 += 1;
}


/* if length is in odd bytes */
if (len == 1)
sum += *((uint8_t *)u16);


return sum;
}


static inline uint16_t __buffer_raw_cksum_reduce(uint32_t sum)
{
sum = ((sum & 0xffff0000) >> 16) + (sum & 0xffff);
sum = ((sum & 0xffff0000) >> 16) + (sum & 0xffff);
return (uint16_t)sum;
}


static inline uint16_t buffer_raw_cksum(const void *buf, size_t len)
{
uint32_t sum;
uint16_t cksum;


sum = __buffer_raw_cksum(buf, len, 0);
cksum = __buffer_raw_cksum_reduce(sum);


cksum = (~cksum) & 0xffff;
if (cksum == 0)
cksum = 0xffff;

return cksum;
}


int main(int argc, char **argv)
{
struct TestSpeedReq req;
int i = 0;

for (i = 0; i < 100; i++) {
req.crc = 0;
req.magic = 100 + i;
req.pkt_len = sizeof(struct TestSpeedReq);
req.seq = 99;
req.type = 77;
req.ver = 4;

uint16_t csum = buffer_raw_cksum((void *)&req, sizeof(req));
req.crc = csum;
printf("cusm %x",csum);

uint16_t csum1 = buffer_raw_cksum((void *)&req, sizeof(req));
printf(" cusm1 %x\n",csum1);
}

return 0;
}