version 1.1.1.1, 2008/11/05 17:02:55
|
version 1.4.2.1, 2011/05/10 20:48:49
|
Line 5
|
Line 5
|
* $Author$ |
* $Author$ |
* $Id$ |
* $Id$ |
* |
* |
*************************************************************************/ | ************************************************************************** |
| The ELWIX and AITNET software is distributed under the following |
| terms: |
| |
| All of the documentation and software included in the ELWIX and AITNET |
| Releases is copyrighted by ELWIX - Sofia/Bulgaria <info@elwix.org> |
| |
| Copyright 2004, 2005, 2006, 2007, 2008, 2009, 2010, 2011 |
| by Michael Pounov <misho@elwix.org>. All rights reserved. |
| |
| Redistribution and use in source and binary forms, with or without |
| modification, are permitted provided that the following conditions |
| are met: |
| 1. Redistributions of source code must retain the above copyright |
| notice, this list of conditions and the following disclaimer. |
| 2. Redistributions in binary form must reproduce the above copyright |
| notice, this list of conditions and the following disclaimer in the |
| documentation and/or other materials provided with the distribution. |
| 3. All advertising materials mentioning features or use of this software |
| must display the following acknowledgement: |
| This product includes software developed by Michael Pounov <misho@elwix.org> |
| ELWIX - Embedded LightWeight unIX and its contributors. |
| 4. Neither the name of AITNET nor the names of its contributors |
| may be used to endorse or promote products derived from this software |
| without specific prior written permission. |
| |
| THIS SOFTWARE IS PROVIDED BY AITNET AND CONTRIBUTORS ``AS IS'' AND |
| ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE |
| IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE |
| ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE |
| FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL |
| DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS |
| OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) |
| HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT |
| LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY |
| OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF |
| SUCH DAMAGE. |
| */ |
#include "global.h" |
#include "global.h" |
|
|
|
|
static int crc_Errno; |
static int crc_Errno; |
static char crc_Error[MAX_STR + 1]; |
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[] = { |
const crcPoly_t crc_Poly[] = { |
{ 1, (u_long) 0x1, "CRC-1-Parity" }, | { 1, (u_int) 0x1, "CRC-1-Parity" }, |
{ 4, (u_long) 0x3, "CRC-4-ITU" }, | { 4, (u_int) 0x3, "CRC-4-ITU" }, |
{ 5, (u_long) 0x15, "CRC-5-ITU" }, | { 5, (u_int) 0x15, "CRC-5-ITU" }, |
{ 6, (u_long) 0x3, "CRC-6-ITU" }, | { 6, (u_int) 0x3, "CRC-6-ITU" }, |
{ 7, (u_long) 0x9, "CRC-7-MMC" }, | { 7, (u_int) 0x9, "CRC-7-MMC" }, |
{ 8, (u_long) 0x8D, "CRC-8-CCITT" }, | { 8, (u_int) 0x8D, "CRC-8-CCITT" }, |
{ 10, (u_long) 0x233, "CRC-10" }, | { 10, (u_int) 0x233, "CRC-10" }, |
{ 11, (u_long) 0x385, "CRC-11-FlexRay" }, | { 11, (u_int) 0x385, "CRC-11-FlexRay" }, |
{ 12, (u_long) 0x80F, "CRC-12-Telco" }, | { 12, (u_int) 0x80F, "CRC-12-Telco" }, |
{ 15, (u_long) 0x4599, "CRC-15-CAN" }, | { 15, (u_int) 0x4599, "CRC-15-CAN" }, |
{ 16, (u_long) 0x8005, "CRC-16-IBM" }, | { 16, (u_int) 0x8005, "CRC-16-IBM" }, |
{ 24, (u_long) 0x864CFB, "CRC-24-Radix64" }, | { 24, (u_int) 0x864CFB, "CRC-24-Radix64" }, |
{ 30, (u_long) 0x2030B9C7, "CRC-30-CDMA" }, | { 30, (u_int) 0x2030B9C7, "CRC-30-CDMA" }, |
{ 32, (u_long) 0x04C11DB7, "CRC-32-802.3" } | { 32, (u_int) 0x04C11DB7, "CRC-32-802.3" } |
}; |
}; |
|
|
// ---------------------------------------------------------- |
// ---------------------------------------------------------- |
|
|
inline int crc_GetErrno() | // |
| // Error maintenance functions ... |
| // |
| |
| // crc_GetErrno() Get error code of last operation |
| inline int |
| crc_GetErrno() |
{ |
{ |
return crc_Errno; |
return crc_Errno; |
} |
} |
|
|
inline const char *crc_GetError() | // crc_GetError() Get error text of last operation |
| inline const char * |
| crc_GetError() |
{ |
{ |
return crc_Error; |
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) |
if (crcNum & i) |
rev |= j; |
rev |= j; |
|
|
Line 57 inline u_long crcReflect(u_long crcNum, u_char crcBits
|
Line 124 inline u_long crcReflect(u_long crcNum, u_char crcBits
|
return rev; |
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; | const u_int bits = sizeof(int) * 8 - crcBits; |
u_long poly, crchibit, crc; | u_int poly, crchibit, crc; |
register u_long i, j, b, ch; | register u_int i, j, b, ch; |
|
|
if (!psBuf) { |
if (!psBuf) { |
crc_Errno = 1; |
crc_Errno = 1; |
Line 119 inline u_long crcCalc(u_char * __restrict psBuf, u_int
|
Line 197 inline u_long crcCalc(u_char * __restrict psBuf, u_int
|
} |
} |
poly <<= bits; |
poly <<= bits; |
|
|
crchibit = (u_long) 1 << (crcBits - 1); | crchibit = (u_int) 1 << (crcBits - 1); |
crchibit <<= bits; |
crchibit <<= bits; |
crc = initCRC << bits; |
crc = initCRC << bits; |
|
|
for (i = 0; i < bufLen; i++) { |
for (i = 0; i < bufLen; i++) { |
ch = (u_long) *psBuf++; | ch = (u_int) *psBuf++; |
if (RevOpts & REVOPTS_REVERTBYTE) |
if (RevOpts & REVOPTS_REVERTBYTE) |
ch = crcReflect(ch, 8); |
ch = crcReflect(ch, 8); |
|
|
Line 140 inline u_long crcCalc(u_char * __restrict psBuf, u_int
|
Line 218 inline u_long crcCalc(u_char * __restrict psBuf, u_int
|
} |
} |
|
|
if (RevOpts & REVOPTS_REVERTCRC) |
if (RevOpts & REVOPTS_REVERTCRC) |
crc = crcReflect(crc, sizeof(long) * 8); | crc = crcReflect(crc, sizeof(int) * 8); |
crc ^= xorCRC << bits; |
crc ^= xorCRC << bits; |
crc &= (((crchibit - 1) << 1) | 1); |
crc &= (((crchibit - 1) << 1) | 1); |
if (!(RevOpts & REVOPTS_REVERTCRC)) |
if (!(RevOpts & REVOPTS_REVERTCRC)) |
Line 152 inline u_long crcCalc(u_char * __restrict psBuf, u_int
|
Line 230 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) { |
if (!nBuf) { |
crc_Errno = 1; |
crc_Errno = 1; |
Line 172 inline u_short crcIP(u_short * __restrict nBuf, int bu
|
Line 257 inline u_short crcIP(u_short * __restrict nBuf, int bu
|
return (u_short) ~sum; |
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) { |
if (!nBuf) { |
crc_Errno = 1; |
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); |
strlcpy(crc_Error, "crcFletcher(): Invalid parameters!", MAX_STR + 1); |
return -1; |
return -1; |
} |
} |
Line 188 inline u_long crcFletcher(u_short * __restrict nBuf, i
|
Line 316 inline u_long crcFletcher(u_short * __restrict nBuf, i
|
bufLen -= clen; |
bufLen -= clen; |
|
|
do { |
do { |
s1 += (u_long) *nBuf++; | s1 += (u_int) *nBuf++; |
s2 += s1; |
s2 += s1; |
} while (--clen); |
} while (--clen); |
|
|
Line 200 inline u_long crcFletcher(u_short * __restrict nBuf, i
|
Line 328 inline u_long crcFletcher(u_short * __restrict nBuf, i
|
return (s2 << 16) | s1; |
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) { |
if (!psBuf) { |
crc_Errno = 1; |
crc_Errno = 1; |
Line 217 inline u_long crcAdler(u_char * __restrict psBuf, int
|
Line 352 inline u_long crcAdler(u_char * __restrict psBuf, int
|
bufLen -= clen; |
bufLen -= clen; |
|
|
do { |
do { |
s1 += (u_long) *psBuf++; | s1 += (u_int) *psBuf++; |
s2 += s1; |
s2 += s1; |
} while (--clen); |
} while (--clen); |
|
|