WebSVN – HelenOS – Diff – /branches/network/uspace/srv/net/checksum.c


/*
 * Copyright (c) 2009 Lukas Mejdrech
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 * - Redistributions of source code must retain the above copyright
 *   notice, this list of conditions and the following disclaimer.
 * - 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.
 * - The name of the author may not be used to endorse or promote products
 *   derived from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``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 AUTHOR 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.
 */
 
/** @addtogroup net
 *  @{
 */
 
/** @file
 *  General CRC and checksum computation implementation.
 */
 
#include <sys/types.h>
 
#include "include/checksum.h"
 
#define CRC_DIVIDER_BE  0x04C11DB7
 
#define CRC_DIVIDER_LE  0xEDB88320
 
/** IP checksum value for computed zero checksum.
 *  Zero is returned as 0xFFFF (not flipped)
 */
#define IP_CHECKSUM_ZERO            0xFFFFu
 
uint32_t compute_crc32_le( uint32_t seed, uint8_t * data, size_t length ){
    size_t  index;
 
    while( length >= 8 ){
        seed ^= ( * data );
        for( index = 0; index < 8; ++ index ){
            if( seed & 1 ){
                seed = ( seed >> 1 ) ^ (( uint32_t ) CRC_DIVIDER_LE );
            }else{
                seed >>= 1;
            }
        }
        ++ data;
        length -= 8;
    }
    if( length > 0 ){
        seed ^= ( * data ) >> ( 8 - length );
        for( index = 0; index < length; ++ index ){
            if( seed & 1 ){
                seed = ( seed >> 1 ) ^ (( uint32_t ) CRC_DIVIDER_LE );
            }else{
                seed >>= 1;
            }
        }
        length -= 8;
    }
    return seed;
}
 
uint32_t compute_crc32_be( uint32_t seed, uint8_t * data, size_t length ){
    size_t  index;
 
    while( length >= 8 ){
        seed ^= ( * data ) << 24;
        for( index = 0; index < 8; ++ index ){
            if( seed & 0x80000000 ){
                seed = ( seed << 1 ) ^ (( uint32_t ) CRC_DIVIDER_BE );
            }else{
                seed <<= 1;
            }
        }
        ++ data;
        length -= 8;
    }
    if( length > 0 ){
        seed ^= (( * data ) & ( 0xFF << ( 8 - length ))) << 24;
        for( index = 0; index < length; ++ index ){
            if( seed & 0x80000000 ){
                seed = ( seed << 1 ) ^ (( uint32_t ) CRC_DIVIDER_BE );
            }else{
                seed <<= 1;
            }
        }
        length -= 8;
    }
    return seed;
}
 
uint32_t compute_checksum( uint32_t seed, uint8_t * data, size_t length ){
    size_t  index;
 
    // sum all the 16 bit fields
    for( index = 0; index + 1 < length; index += 2 ){
        seed += ( data[ index ] << 8 ) + data[ index + 1 ];
    }
 
    // last odd byte with zero padding
    if( index + 1 == length ){
        seed += data[ index ] << 8;
    }
 
    return seed;
}
 
uint16_t compact_checksum( uint32_t sum ){
    // shorten to the 16 bits
    while( sum >> 16 ) sum = ( sum & 0xFFFF ) + ( sum >> 16 );
 
    return ( uint16_t ) sum;
}
 
uint16_t flip_checksum( uint16_t checksum ){
    // flip, zero is returned as 0xFFFF (not flipped)
    return ( ~ checksum ) ? ( uint16_t ) ( ~ checksum ) : IP_CHECKSUM_ZERO;
}
 
uint16_t ip_checksum( uint8_t * data, size_t length ){
    return flip_checksum( compact_checksum( compute_checksum( 0, data, length )));
}
 
/** @}
 */
 

Rev 4722	Rev 4743
1	/*	1	/*
2	* Copyright (c) 2009 Lukas Mejdrech	2	* Copyright (c) 2009 Lukas Mejdrech
3	* All rights reserved.	3	* All rights reserved.
4	*	4	*
5	* Redistribution and use in source and binary forms, with or without	5	* Redistribution and use in source and binary forms, with or without
6	* modification, are permitted provided that the following conditions	6	* modification, are permitted provided that the following conditions
7	* are met:	7	* are met:
8	*	8	*
9	* - Redistributions of source code must retain the above copyright	9	* - Redistributions of source code must retain the above copyright
10	* notice, this list of conditions and the following disclaimer.	10	* notice, this list of conditions and the following disclaimer.
11	* - Redistributions in binary form must reproduce the above copyright	11	* - Redistributions in binary form must reproduce the above copyright
12	* notice, this list of conditions and the following disclaimer in the	12	* notice, this list of conditions and the following disclaimer in the
13	* documentation and/or other materials provided with the distribution.	13	* documentation and/or other materials provided with the distribution.
14	* - The name of the author may not be used to endorse or promote products	14	* - The name of the author may not be used to endorse or promote products
15	* derived from this software without specific prior written permission.	15	* derived from this software without specific prior written permission.
16	*	16	*
17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR	17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES	18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.	19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,	20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT	21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,	22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY	23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT	24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF	25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.	26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27	*/	27	*/
28		28
29	/** @addtogroup net	29	/** @addtogroup net
30	* @{	30	* @{
31	*/	31	*/
32		32
33	/** @file	33	/** @file
34	* General CRC and checksum computation implementation.	34	* General CRC and checksum computation implementation.
35	*/	35	*/
36		36
37	#include <sys/types.h>	37	#include <sys/types.h>
38		38
39	#include "include/crc.h"	39	#include "include/checksum.h"
40		40
41	#define CRC_DIVIDER_BE 0x04C11DB7	41	#define CRC_DIVIDER_BE 0x04C11DB7
42		42
43	#define CRC_DIVIDER_LE 0xEDB88320	43	#define CRC_DIVIDER_LE 0xEDB88320
44		44
45	/** IP checksum value for computed zero checksum.	45	/** IP checksum value for computed zero checksum.
46	* Zero is returned as 0xFFFF (not flipped)	46	* Zero is returned as 0xFFFF (not flipped)
47	*/	47	*/
48	#define IP_CHECKSUM_ZERO 0xFFFFu	48	#define IP_CHECKSUM_ZERO 0xFFFFu
49		49
50	uint32_t compute_crc32_le( uint32_t seed, uint8_t * data, size_t length ){	50	uint32_t compute_crc32_le( uint32_t seed, uint8_t * data, size_t length ){
51	size_t index;	51	size_t index;
52		52
53	while( length >= 8 ){	53	while( length >= 8 ){
54	seed ^= ( * data );	54	seed ^= ( * data );
55	for( index = 0; index < 8; ++ index ){	55	for( index = 0; index < 8; ++ index ){
56	if( seed & 1 ){	56	if( seed & 1 ){
57	seed = ( seed >> 1 ) ^ (( uint32_t ) CRC_DIVIDER_LE );	57	seed = ( seed >> 1 ) ^ (( uint32_t ) CRC_DIVIDER_LE );
58	}else{	58	}else{
59	seed >>= 1;	59	seed >>= 1;
60	}	60	}
61	}	61	}
62	++ data;	62	++ data;
63	length -= 8;	63	length -= 8;
64	}	64	}
65	if( length > 0 ){	65	if( length > 0 ){
66	seed ^= ( * data ) >> ( 8 - length );	66	seed ^= ( * data ) >> ( 8 - length );
67	for( index = 0; index < length; ++ index ){	67	for( index = 0; index < length; ++ index ){
68	if( seed & 1 ){	68	if( seed & 1 ){
69	seed = ( seed >> 1 ) ^ (( uint32_t ) CRC_DIVIDER_LE );	69	seed = ( seed >> 1 ) ^ (( uint32_t ) CRC_DIVIDER_LE );
70	}else{	70	}else{
71	seed >>= 1;	71	seed >>= 1;
72	}	72	}
73	}	73	}
74	length -= 8;	74	length -= 8;
75	}	75	}
76	return seed;	76	return seed;
77	}	77	}
78		78
79	uint32_t compute_crc32_be( uint32_t seed, uint8_t * data, size_t length ){	79	uint32_t compute_crc32_be( uint32_t seed, uint8_t * data, size_t length ){
80	size_t index;	80	size_t index;
81		81
82	while( length >= 8 ){	82	while( length >= 8 ){
83	seed ^= ( * data ) << 24;	83	seed ^= ( * data ) << 24;
84	for( index = 0; index < 8; ++ index ){	84	for( index = 0; index < 8; ++ index ){
85	if( seed & 0x80000000 ){	85	if( seed & 0x80000000 ){
86	seed = ( seed << 1 ) ^ (( uint32_t ) CRC_DIVIDER_BE );	86	seed = ( seed << 1 ) ^ (( uint32_t ) CRC_DIVIDER_BE );
87	}else{	87	}else{
88	seed <<= 1;	88	seed <<= 1;
89	}	89	}
90	}	90	}
91	++ data;	91	++ data;
92	length -= 8;	92	length -= 8;
93	}	93	}
94	if( length > 0 ){	94	if( length > 0 ){
95	seed ^= (( * data ) & ( 0xFF << ( 8 - length ))) << 24;	95	seed ^= (( * data ) & ( 0xFF << ( 8 - length ))) << 24;
96	for( index = 0; index < length; ++ index ){	96	for( index = 0; index < length; ++ index ){
97	if( seed & 0x80000000 ){	97	if( seed & 0x80000000 ){
98	seed = ( seed << 1 ) ^ (( uint32_t ) CRC_DIVIDER_BE );	98	seed = ( seed << 1 ) ^ (( uint32_t ) CRC_DIVIDER_BE );
99	}else{	99	}else{
100	seed <<= 1;	100	seed <<= 1;
101	}	101	}
102	}	102	}
103	length -= 8;	103	length -= 8;
104	}	104	}
105	return seed;	105	return seed;
106	}	106	}
107		107
108	uint32_t compute_checksum( uint32_t seed, uint8_t * data, size_t length ){	108	uint32_t compute_checksum( uint32_t seed, uint8_t * data, size_t length ){
109	size_t index;	109	size_t index;
110		110
111	// sum all the 16 bit fields	111	// sum all the 16 bit fields
112	for( index = 0; index + 1 < length; index += 2 ){	112	for( index = 0; index + 1 < length; index += 2 ){
113	seed += ( data[ index ] << 8 ) + data[ index + 1 ];	113	seed += ( data[ index ] << 8 ) + data[ index + 1 ];
114	}	114	}
115		115
116	// last odd byte with zero padding	116	// last odd byte with zero padding
117	if( index + 1 == length ){	117	if( index + 1 == length ){
118	seed += data[ index ] << 8;	118	seed += data[ index ] << 8;
119	}	119	}
120		120
121	return seed;	121	return seed;
122	}	122	}
123		123
124	uint16_t compact_checksum( uint32_t sum ){	124	uint16_t compact_checksum( uint32_t sum ){
125	// shorten to the 16 bits	125	// shorten to the 16 bits
126	while( sum >> 16 ) sum = ( sum & 0xFFFF ) + ( sum >> 16 );	126	while( sum >> 16 ) sum = ( sum & 0xFFFF ) + ( sum >> 16 );
127		127
128	return ( uint16_t ) sum;	128	return ( uint16_t ) sum;
129	}	129	}
130		130
131	uint16_t flip_checksum( uint16_t checksum ){	131	uint16_t flip_checksum( uint16_t checksum ){
132	// flip, zero is returned as 0xFFFF (not flipped)	132	// flip, zero is returned as 0xFFFF (not flipped)
133	return ( ~ checksum ) ? ( uint16_t ) ( ~ checksum ) : IP_CHECKSUM_ZERO;	133	return ( ~ checksum ) ? ( uint16_t ) ( ~ checksum ) : IP_CHECKSUM_ZERO;
134	}	134	}
135		135
136	uint16_t ip_checksum( uint8_t * data, size_t length ){	136	uint16_t ip_checksum( uint8_t * data, size_t length ){
137	return flip_checksum( compact_checksum( compute_checksum( 0, data, length )));	137	return flip_checksum( compact_checksum( compute_checksum( 0, data, length )));
138	}	138	}
139		139
140	/** @}	140	/** @}
141	*/	141	*/
142		142

Subversion Repositories HelenOS

(root)/branches/network/uspace/srv/net/checksum.c – Rev 4722 → 4743