libelwix/src/crc.c - diff

Return to crc.c CVS log

Up to [ELWIX - Embedded LightWeight unIX -] / libelwix / src

Diff for /libelwix/src/crc.c between versions 1.2 and 1.9

version 1.2, 2013/08/12 02:10:44	version 1.9, 2024/10/28 09:58:51
Line 12 terms:	Line 12 terms:
All of the documentation and software included in the ELWIX and AITNET	All of the documentation and software included in the ELWIX and AITNET
Releases is copyrighted by ELWIX - Sofia/Bulgaria <info@elwix.org>	Releases is copyrighted by ELWIX - Sofia/Bulgaria <info@elwix.org>

Copyright 2004, 2005, 2006, 2007, 2008, 2009, 2010, 2011, 2012, 2013	Copyright 2004 - 2024
by Michael Pounov <misho@elwix.org>. All rights reserved.	by Michael Pounov <misho@elwix.org>. All rights reserved.

Redistribution and use in source and binary forms, with or without	Redistribution and use in source and binary forms, with or without
Line 46 SUCH DAMAGE.	Line 46 SUCH DAMAGE.
#include "global.h"	#include "global.h"


	/* CRC16 poly */
	const u_short crc_16poly = 0x1021;

/* Adler module */	/* Adler module */
const u_int crc_modAdler = 0xFFF1L;	const u_int crc_modAdler = 0xFFF1L;

Line 56 const crcPoly_t crc_Poly[] = {	Line 59 const crcPoly_t crc_Poly[] = {
{ 5, (u_int) 0x15, "CRC-5-ITU" },	{ 5, (u_int) 0x15, "CRC-5-ITU" },
{ 6, (u_int) 0x3, "CRC-6-ITU" },	{ 6, (u_int) 0x3, "CRC-6-ITU" },
{ 7, (u_int) 0x9, "CRC-7-MMC" },	{ 7, (u_int) 0x9, "CRC-7-MMC" },
{ 8, (u_int) 0x8D, "CRC-8-CCITT" },	{ 8, (u_int) 0x7, "CRC-8-CCITT" },
{ 10, (u_int) 0x233, "CRC-10" },	{ 10, (u_int) 0x233, "CRC-10" },
{ 11, (u_int) 0x385, "CRC-11-FlexRay" },	{ 11, (u_int) 0x385, "CRC-11-FlexRay" },
{ 12, (u_int) 0x80F, "CRC-12-Telco" },	{ 12, (u_int) 0x80F, "CRC-12-Telco" },
Line 64 const crcPoly_t crc_Poly[] = {	Line 67 const crcPoly_t crc_Poly[] = {
{ 16, (u_int) 0x8005, "CRC-16-IBM" },	{ 16, (u_int) 0x8005, "CRC-16-IBM" },
{ 24, (u_int) 0x864CFB, "CRC-24-Radix64" },	{ 24, (u_int) 0x864CFB, "CRC-24-Radix64" },
{ 30, (u_int) 0x2030B9C7, "CRC-30-CDMA" },	{ 30, (u_int) 0x2030B9C7, "CRC-30-CDMA" },
{ 32, (u_int) 0x04C11DB7, "CRC-32-802.3" }	{ 32, (u_int) 0x04C11DB7, "CRC-32-802.3" },
	{ 16, (u_int) 0x1021, "CRC-16-CCITT" },
	{ 16, (u_int) 0x8408, "CRC-16-XMODEM" }
};	};


Line 73 const crcPoly_t crc_Poly[] = {	Line 78 const crcPoly_t crc_Poly[] = {
*	*
* @crcNum = Number for reflection	* @crcNum = Number for reflection
* @crcBits = Number width bits	* @crcBits = Number width bits
* return: -1 error, !=-1 reflecting number	* return: reflecting number
*/	*/
inline u_int	u_int
crcReflect(u_int crcNum, u_char crcBits)	crcReflect(u_int crcNum, u_char crcBits)
{	{
register u_int i, j = 1, rev = 0;	register u_int i, j = 1, rev = 0;
Line 95 crcReflect(u_int crcNum, u_char crcBits)	Line 100 crcReflect(u_int crcNum, u_char crcBits)
* @RevOpts = Options for computation (REVOPTS_REVERTBYTE, REVOPTS_REVERTCRC)	* @RevOpts = Options for computation (REVOPTS_REVERTBYTE, REVOPTS_REVERTCRC)
* @initCRC = Initial CRC value	* @initCRC = Initial CRC value
* @xorCRC = Last xor CRC value	* @xorCRC = Last xor CRC value
* return: -1 error, !=-1 CRC checksum	* return: CRC checksum
*/	*/
inline u_int	u_int
crcCalc(u_char * __restrict psBuf, u_int bufLen, u_char crcBits, u_char RevOpts, u_int initCRC, u_int xorCRC)	crcCalc(u_char * __restrict psBuf, u_int bufLen, u_char crcBits, u_char RevOpts, u_int initCRC, u_int xorCRC)
{	{
const u_int bits = sizeof(int) * 8 - crcBits;	u_int bits = sizeof(int) * 8;
u_int poly, crchibit, crc;	u_int poly, crchibit, crc;
register u_int i, j, b, ch;	register u_int i, j, b, ch;

Line 109 crcCalc(u_char * __restrict psBuf, u_int bufLen, u_cha	Line 114 crcCalc(u_char * __restrict psBuf, u_int bufLen, u_cha
switch (crcBits) {	switch (crcBits) {
case 1:	case 1:
poly = crc_Poly[0].poly_num;	poly = crc_Poly[0].poly_num;
	bits -= crc_Poly[0].poly_bits;
break;	break;
case 4:	case 4:
poly = crc_Poly[1].poly_num;	poly = crc_Poly[1].poly_num;
	bits -= crc_Poly[1].poly_bits;
break;	break;
case 5:	case 5:
poly = crc_Poly[2].poly_num;	poly = crc_Poly[2].poly_num;
	bits -= crc_Poly[2].poly_bits;
break;	break;
case 6:	case 6:
poly = crc_Poly[3].poly_num;	poly = crc_Poly[3].poly_num;
	bits -= crc_Poly[3].poly_bits;
break;	break;
case 7:	case 7:
poly = crc_Poly[4].poly_num;	poly = crc_Poly[4].poly_num;
	bits -= crc_Poly[4].poly_bits;
break;	break;
case 8:	case 8:
poly = crc_Poly[5].poly_num;	poly = crc_Poly[5].poly_num;
	bits -= crc_Poly[5].poly_bits;
break;	break;
case 10:	case 10:
poly = crc_Poly[6].poly_num;	poly = crc_Poly[6].poly_num;
	bits -= crc_Poly[6].poly_bits;
break;	break;
case 11:	case 11:
poly = crc_Poly[7].poly_num;	poly = crc_Poly[7].poly_num;
	bits -= crc_Poly[7].poly_bits;
break;	break;
case 12:	case 12:
poly = crc_Poly[8].poly_num;	poly = crc_Poly[8].poly_num;
	bits -= crc_Poly[8].poly_bits;
break;	break;
case 15:	case 15:
poly = crc_Poly[9].poly_num;	poly = crc_Poly[9].poly_num;
	bits -= crc_Poly[9].poly_bits;
break;	break;
case 16:	case 16:
poly = crc_Poly[10].poly_num;	poly = crc_Poly[10].poly_num;
	bits -= crc_Poly[10].poly_bits;
break;	break;
case 24:	case 24:
poly = crc_Poly[11].poly_num;	poly = crc_Poly[11].poly_num;
	bits -= crc_Poly[11].poly_bits;
break;	break;
case 30:	case 30:
poly = crc_Poly[12].poly_num;	poly = crc_Poly[12].poly_num;
	bits -= crc_Poly[12].poly_bits;
break;	break;
case 32:	case 32:
poly = crc_Poly[13].poly_num;	poly = crc_Poly[13].poly_num;
	bits -= crc_Poly[13].poly_bits;
break;	break;
	case 161:
	poly = crc_Poly[14].poly_num;
	bits -= crc_Poly[14].poly_bits;
	crcBits = crc_Poly[14].poly_bits;
	break;
	case 162:
	poly = crc_Poly[15].poly_num;
	bits -= crc_Poly[15].poly_bits;
	crcBits = crc_Poly[15].poly_bits;
	break;
default:	default:
elwix_SetErr(EINVAL, "crcCalc(): Unsupported CRC method!!!");	elwix_SetErr(EINVAL, "crcCalc(): Unsupported CRC method!!!");
return -1;	return -1;
Line 187 crcCalc(u_char * __restrict psBuf, u_int bufLen, u_cha	Line 216 crcCalc(u_char * __restrict psBuf, u_int bufLen, u_cha


/*	/*
* crcIP() - Checksum in IP communication	* crc16_xy() - Checksum calculation in X/Y modem communication
*	*
* @buf = Data for calculation	* @buf = Data for calculation
* @bufLen = Length of data	* @bufLen = Length of data
* return: -1 error, !=-1 Checksum	* return: Checksum
*/	*/
inline u_short	u_short
crcIP(u_char * __restrict buf, int bufLen)	crc16_xy(u_char * __restrict buf, int bufLen)
{	{
register u_int sum;	u_short crc, x;
u_short last = 0, nBuf = (u_short) buf;	register u_short i;

assert(buf);	assert(buf);

for (sum = 0; bufLen && bufLen > 1; bufLen -= 2)	for (crc = 0; bufLen > 0; bufLen--, buf++)
sum += *nBuf++;	for (i = 0x80; i; i >>= 1) {
if (bufLen == 1) {	x = crc >> 15;
(u_char)(&last) += (u_char) nBuf;	crc <<= 1;
sum += last;
	if (*buf & i)
	crc++;
	if (x)
	crc ^= crc_16poly;
	}

	for (i = 0; i < 16; i++) {
	x = crc >> 15;
	crc <<= 1;

	if (x)
	crc ^= crc_16poly;
}	}

	return crc;
	}

	/*
	* crc16_ccitt() - Checksum calculation
	*
	* @buf = Data for calculation
	* @bufLen = Length of data
	* return: Checksum
	*/
	u_short
	crc16_ccitt(u_char * __restrict buf, int bufLen)
	{
	u_short crc;
	register u_char i;

	for (crc = 0; bufLen > 0; bufLen--, buf++) {
	crc ^= (u_short) *buf << 8;
	for (i = 0x80; i; i >>= 1)
	if (crc & 0x8000)
	crc = crc << 1 ^ crc_16poly;
	else
	crc <<= 1;
	}

	return crc;
	}

	/*
	* crcIP() - Checksum in IP communication
	*
	* @buf = Data for calculation
	* @len = Length of data in bytes
	* return: Checksum
	*/
	u_short
	crcIP(u_short* __restrict buf, int len)
	{
	register u_long sum = 0;

	assert(buf);

	for (sum = 0; len > 1; len -= 2)
	sum += *buf++;
	if (len > 0)
	sum += ((*buf) & htons(0xFF00));

sum = (sum >> 16) + (sum & 0xFFFF);	sum = (sum >> 16) + (sum & 0xFFFF);
sum += sum >> 16;	sum += sum >> 16;

return (u_short) ~sum;	return (u_short) (~sum);
}	}

/*	/*
	* crcTCP() - Checksum for TCP v4 communication
	*
	* @buf = Data for calculation
	* @bufLen = Length of data
	* @th = TCP header
	* return: Checksum
	*/
	u_short
	crcTCP(struct in_addr src, struct in_addr dst, u_char * __restrict th)
	{
	struct psd_tcp {
	struct in_addr src;
	struct in_addr dst;
	u_char pad;
	u_char proto;
	u_short tcp_len;
	u_char tcp[20];
	} buf;

	buf.src = src;
	buf.dst = dst;
	buf.pad = 0;
	buf.proto = IPPROTO_TCP;
	buf.tcp_len = htons(sizeof buf.tcp);
	memcpy(&buf.tcp, th, sizeof buf.tcp);

	return crcIP((u_short*) &buf, sizeof buf);
	}

	/*
	* crcUDP() - Checksum for UDP v4 communication
	*
	* @buf = Data for calculation
	* @bufLen = Length of data
	* @uh = UDP header
	* return: Checksum
	*/
	u_short
	crcUDP(struct in_addr src, struct in_addr dst, u_char * __restrict uh)
	{
	struct psd_udp {
	struct in_addr src;
	struct in_addr dst;
	u_char pad;
	u_char proto;
	u_short udp_len;
	u_char udp[8];
	} buf;

	buf.src = src;
	buf.dst = dst;
	buf.pad = 0;
	buf.proto = IPPROTO_UDP;
	buf.udp_len = htons(sizeof buf.udp);
	memcpy(&buf.udp, uh, sizeof buf.udp);

	return crcIP((u_short*) &buf, sizeof buf);
	}


	/*
* crcFletcher16() - Fletcher-16 Checksum computing	* crcFletcher16() - Fletcher-16 Checksum computing
*	*
* @nBuf = Data for calculation	* @nBuf = Data for calculation
* @bufLen = Length of data	* @bufLen = Length of data
* return: -1 error, !=-1 Checksum	* return: Checksum
*/	*/
inline u_short	u_short
crcFletcher16(u_short * __restrict nBuf, int bufLen)	crcFletcher16(u_short * __restrict nBuf, int bufLen)
{	{
register u_short s1, s2;	register u_short s1, s2;
Line 251 crcFletcher16(u_short * __restrict nBuf, int bufLen)	Line 400 crcFletcher16(u_short * __restrict nBuf, int bufLen)
*	*
* @nBuf = Data for calculation	* @nBuf = Data for calculation
* @bufLen = Length of data	* @bufLen = Length of data
* return: -1 error, !=-1 Checksum	* return: Checksum
*/	*/
inline u_int	u_int
crcFletcher(u_short * __restrict nBuf, int bufLen)	crcFletcher(u_short * __restrict nBuf, int bufLen)
{	{
register u_int s1, s2, clen;	register u_int s1, s2, clen;
Line 282 crcFletcher(u_short * __restrict nBuf, int bufLen)	Line 431 crcFletcher(u_short * __restrict nBuf, int bufLen)
*	*
* @psBuf = Data for calculation	* @psBuf = Data for calculation
* @bufLen = Length of data	* @bufLen = Length of data
* return: -1 error, !=-1 Checksum	* return: Checksum
*/	*/
inline u_int	u_int
crcAdler(u_char * __restrict psBuf, int bufLen)	crcAdler(u_char * __restrict psBuf, int bufLen)
{	{
register u_int s1 = 1, s2 = 0, clen;	register u_int s1 = 1, s2 = 0, clen;

FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>

Removed from v.1.2
changed lines
	Added in v.1.9