--- libaitcrc/src/aitcrc.c 2008/11/05 17:02:55 1.1 +++ libaitcrc/src/aitcrc.c 2010/06/13 16:13:51 1.3 @@ -3,7 +3,7 @@ * by Michael Pounov * * $Author: misho $ -* $Id: aitcrc.c,v 1.1 2008/11/05 17:02:55 misho Exp $ +* $Id: aitcrc.c,v 1.3 2010/06/13 16:13:51 misho Exp $ * *************************************************************************/ #include "global.h" @@ -12,44 +12,71 @@ static int crc_Errno; static char crc_Error[MAX_STR + 1]; -const u_long crc_modAdler = 0xFFF1L; +// Adler module +const u_int crc_modAdler = 0xFFF1L; +// All known library CRC types ... const crcPoly_t crc_Poly[] = { - { 1, (u_long) 0x1, "CRC-1-Parity" }, - { 4, (u_long) 0x3, "CRC-4-ITU" }, - { 5, (u_long) 0x15, "CRC-5-ITU" }, - { 6, (u_long) 0x3, "CRC-6-ITU" }, - { 7, (u_long) 0x9, "CRC-7-MMC" }, - { 8, (u_long) 0x8D, "CRC-8-CCITT" }, - { 10, (u_long) 0x233, "CRC-10" }, - { 11, (u_long) 0x385, "CRC-11-FlexRay" }, - { 12, (u_long) 0x80F, "CRC-12-Telco" }, - { 15, (u_long) 0x4599, "CRC-15-CAN" }, - { 16, (u_long) 0x8005, "CRC-16-IBM" }, - { 24, (u_long) 0x864CFB, "CRC-24-Radix64" }, - { 30, (u_long) 0x2030B9C7, "CRC-30-CDMA" }, - { 32, (u_long) 0x04C11DB7, "CRC-32-802.3" } + { 1, (u_int) 0x1, "CRC-1-Parity" }, + { 4, (u_int) 0x3, "CRC-4-ITU" }, + { 5, (u_int) 0x15, "CRC-5-ITU" }, + { 6, (u_int) 0x3, "CRC-6-ITU" }, + { 7, (u_int) 0x9, "CRC-7-MMC" }, + { 8, (u_int) 0x8D, "CRC-8-CCITT" }, + { 10, (u_int) 0x233, "CRC-10" }, + { 11, (u_int) 0x385, "CRC-11-FlexRay" }, + { 12, (u_int) 0x80F, "CRC-12-Telco" }, + { 15, (u_int) 0x4599, "CRC-15-CAN" }, + { 16, (u_int) 0x8005, "CRC-16-IBM" }, + { 24, (u_int) 0x864CFB, "CRC-24-Radix64" }, + { 30, (u_int) 0x2030B9C7, "CRC-30-CDMA" }, + { 32, (u_int) 0x04C11DB7, "CRC-32-802.3" } }; // ---------------------------------------------------------- +// +// Error maintenance functions ... +// + +// crc_GetErrno() Get error code of last operation inline int crc_GetErrno() { return crc_Errno; } +// crc_GetError() Get error text of last operation inline const char *crc_GetError() { return crc_Error; } +// crcSetErr() Set error to variables for internal use!!! +inline void crcSetErr(int eno, char *estr, ...) +{ + va_list lst; + + crc_Errno = eno; + memset(crc_Error, 0, MAX_STR + 1); + va_start(lst, estr); + vsnprintf(crc_Error, MAX_STR + 1, estr, lst); + va_end(lst); +} + // ---------------------------------------------------------- -inline u_long crcReflect(u_long crcNum, u_char crcBits) +/* + * crcReflect() Reflect all bits of number + * @crcNum = Number for reflection + * @crcBits = Number width bits + * return: -1 error, !=-1 reflecting number + */ +inline u_int +crcReflect(u_int crcNum, u_char crcBits) { - register u_long i, j, rev; + register u_int i, j, rev; - for (i = (u_long) 1 << (crcBits - 1), j = 1, rev ^= rev; i; i >>= 1, j <<= 1) + for (i = (u_int) 1 << (crcBits - 1), j = 1, rev ^= rev; i; i >>= 1, j <<= 1) if (crcNum & i) rev |= j; @@ -57,11 +84,22 @@ inline u_long crcReflect(u_long crcNum, u_char crcBits return rev; } -inline u_long crcCalc(u_char * __restrict psBuf, u_int bufLen, u_char crcBits, u_char RevOpts, u_long initCRC, u_long xorCRC) +/* + * crcCalc() Generic CRC calculation function for many sub variants of CRC algorithms + * @psBuf = Data for calculation + * @bufLen = Length of data + * @crcBits = CRC algorithm bits (1, 4, 5, 6, 7, 8, 10, 11, 12, 15, 16, 24, 30, 32) + * @RevOpts = Options for computation (REVOPTS_REVERTBYTE, REVOPTS_REVERTCRC) + * @initCRC = Initial CRC value + * @xorCRC = Last xor CRC value + * return: -1 error, !=-1 CRC checksum + */ +inline u_int +crcCalc(u_char * __restrict psBuf, u_int bufLen, u_char crcBits, u_char RevOpts, u_int initCRC, u_int xorCRC) { - const u_long bits = sizeof(long) * 8 - crcBits; - u_long poly, crchibit, crc; - register u_long i, j, b, ch; + const u_int bits = sizeof(int) * 8 - crcBits; + u_int poly, crchibit, crc; + register u_int i, j, b, ch; if (!psBuf) { crc_Errno = 1; @@ -119,12 +157,12 @@ inline u_long crcCalc(u_char * __restrict psBuf, u_int } poly <<= bits; - crchibit = (u_long) 1 << (crcBits - 1); + crchibit = (u_int) 1 << (crcBits - 1); crchibit <<= bits; crc = initCRC << bits; for (i = 0; i < bufLen; i++) { - ch = (u_long) *psBuf++; + ch = (u_int) *psBuf++; if (RevOpts & REVOPTS_REVERTBYTE) ch = crcReflect(ch, 8); @@ -140,7 +178,7 @@ inline u_long crcCalc(u_char * __restrict psBuf, u_int } if (RevOpts & REVOPTS_REVERTCRC) - crc = crcReflect(crc, sizeof(long) * 8); + crc = crcReflect(crc, sizeof(int) * 8); crc ^= xorCRC << bits; crc &= (((crchibit - 1) << 1) | 1); if (!(RevOpts & REVOPTS_REVERTCRC)) @@ -152,9 +190,16 @@ inline u_long crcCalc(u_char * __restrict psBuf, u_int // ---------------------------------------------------------- -inline u_short crcIP(u_short * __restrict nBuf, int bufLen) +/* + * crcIP() Checksum in IP communication + * @nBuf = Data for calculation + * @bufLen = Length of data + * return: -1 error, !=-1 Checksum + */ +inline u_short +crcIP(u_short * __restrict nBuf, int bufLen) { - register u_long sum; + register u_int sum; if (!nBuf) { crc_Errno = 1; @@ -172,12 +217,55 @@ inline u_short crcIP(u_short * __restrict nBuf, int bu return (u_short) ~sum; } -inline u_long crcFletcher(u_short * __restrict nBuf, int bufLen) +/* + * crcFletcher16() Fletcher-16 Checksum computing + * @nBuf = Data for calculation + * @bufLen = Length of data + * return: -1 error, !=-1 Checksum + */ +inline u_short +crcFletcher16(u_short * __restrict nBuf, int bufLen) { - register u_long s1, s2, clen; + register u_short s1, s2; + register u_int clen; if (!nBuf) { crc_Errno = 1; + strlcpy(crc_Error, "crcFletcher16(): Invalid parameters!", MAX_STR + 1); + return -1; + } + + s1 = s2 = 0xFF; + while (bufLen) { + clen = bufLen > MAX_FLETCHER16_DIGEST ? MAX_FLETCHER16_DIGEST : bufLen; + bufLen -= clen; + + do { + s1 += (u_short) *nBuf++; + s2 += s1; + } while (--clen); + + s1 = (s1 >> 8) + (s1 & 0xFF); + s2 = (s2 >> 8) + (s2 & 0xFF); + } + + crc_Errno ^= crc_Errno; + return (s2 << 8) | s1; +} + +/* + * crcFletcher() Fletcher-32 Checksum computing + * @nBuf = Data for calculation + * @bufLen = Length of data + * return: -1 error, !=-1 Checksum + */ +inline u_int +crcFletcher(u_short * __restrict nBuf, int bufLen) +{ + register u_int s1, s2, clen; + + if (!nBuf) { + crc_Errno = 1; strlcpy(crc_Error, "crcFletcher(): Invalid parameters!", MAX_STR + 1); return -1; } @@ -188,7 +276,7 @@ inline u_long crcFletcher(u_short * __restrict nBuf, i bufLen -= clen; do { - s1 += (u_long) *nBuf++; + s1 += (u_int) *nBuf++; s2 += s1; } while (--clen); @@ -200,9 +288,16 @@ inline u_long crcFletcher(u_short * __restrict nBuf, i return (s2 << 16) | s1; } -inline u_long crcAdler(u_char * __restrict psBuf, int bufLen) +/* + * crcAdler() crcAdler-32 Checksum computing + * @psBuf = Data for calculation + * @bufLen = Length of data + * return: -1 error, !=-1 Checksum + */ +inline u_int +crcAdler(u_char * __restrict psBuf, int bufLen) { - register u_long s1, s2, clen; + register u_int s1, s2, clen; if (!psBuf) { crc_Errno = 1; @@ -217,7 +312,7 @@ inline u_long crcAdler(u_char * __restrict psBuf, int bufLen -= clen; do { - s1 += (u_long) *psBuf++; + s1 += (u_int) *psBuf++; s2 += s1; } while (--clen);