#include <windows.h>
#include <stdio.h>

#define CRC_POLY 0x1021
#define CRC_WLEN 256 // number of 16bit words within block

USHORT pack[CRC_WLEN];
USHORT ctab[256];

__inline USHORT crc_update_simple(USHORT crc, USHORT data)
{
ULONG i;

crc = crc ^ (data << 8);
for (i=0; i<8; i++)
{
if (crc & 0x8000)
{
crc = (crc << 1)^CRC_POLY;
}
else
{
crc <<= 1;
}
}

crc = crc ^ (data & 0xFF00);
for (i=0; i<8; i++)
{
if (crc & 0x8000)
{
crc = (crc << 1)^CRC_POLY;
}
else
{
crc <<= 1;
}
}
return crc;
}

__inline USHORT crc_update_tab(USHORT crc, USHORT data)
{
crc = crc ^ (data << 8);
crc = ctab[crc >> 8] ^ (crc << 8);
crc = crc ^ (data & 0xFF00);
crc = ctab[crc >> 8] ^ (crc << 8);
return crc;
}

void crc_init(void)
{
ULONG i, j;

for(i=0; i<256; i++)
{
USHORT t;

t = (USHORT)(i << 8);
for (j=0; j<8; j++)
{
if (t & 0x8000)
{
t = (t << 1)^CRC_POLY;
}
else
{
t <<= 1;
}
}
ctab[i] = t;
}
}


__inline USHORT crc_calc_simple(USHORT *buf, ULONG len)
{
USHORT crc;

crc = 0;
if (len)
{
do
{
crc = crc_update_simple(crc, *buf++);
}
while(--len);
}
return crc;
}

__inline USHORT crc_calc_tab(USHORT *buf, ULONG len)
{
USHORT crc;

crc = 0;
if (len)
{
do
{
crc = crc_update_tab(crc, *buf++);
}
while(--len);
}
return crc;
}

void main(void)
{
ULONG start;
USHORT crc, *p1, *p2;
ULONG i1, i2;

crc_init();
printf("\r\nChecking %d-bit block", CRC_WLEN*16);

start = GetTickCount();
memset(pack, 0, sizeof(pack));
for(p1 = pack; p1 < &pack[CRC_WLEN]
{
printf("\r\n%d", p1-pack);
for(i1=0; i1<16; i1++)
{
for(p2 = pack; p2 < &pack[CRC_WLEN]; p2++)
{
for(i2=0; i2<16; i2++)
{
*p1 = (1<<i1);
*p2 |= (1<<i2);
//
// crc = crc_calc_simple(pack, CRC_WLEN);
//
crc = crc_calc_tab(pack, CRC_WLEN);
if (crc == 0)
{
printf("\r\nCRC fail: %d, %d", (p1-pack)*16 + i1, (p2-pack)*16 + i2);
}
*p2 &= ~(1<<i2);
}
}
}
*p1++ = 0;
}
start = GetTickCount() - start;
printf("\r\n%d ms elapsed\r\n", start);
}