diff options
Diffstat (limited to 'machine/in_cksum.h')
| -rw-r--r-- | machine/in_cksum.h | 295 |
1 files changed, 295 insertions, 0 deletions
diff --git a/machine/in_cksum.h b/machine/in_cksum.h new file mode 100644 index 0000000..67dafb6 --- /dev/null +++ b/machine/in_cksum.h @@ -0,0 +1,295 @@ +/* + * Nios II version by Jeffrey O. Hill + * + * Copyright 2012. Los Alamos National Security, LLC. + * The Nios II specific part was produced under U.S. Government contract + * DE-AC52-06NA25396 for Los Alamos National Laboratory (LANL), + * which is operated by Los Alamos National Security, LLC for + * the U.S. Department of Energy. The U.S. Government has rights + * to use, reproduce, and distribute this software. NEITHER THE + * GOVERNMENT NOR LOS ALAMOS NATIONAL SECURITY, LLC MAKES ANY + * WARRANTY, EXPRESS OR IMPLIED, OR ASSUMES ANY LIABILITY FOR + * THE USE OF THIS SOFTWARE. + * + * Copyright (c) 1990 The Regents of the University of California. + * 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 the University of + * California, Berkeley and its contributors. + * 4. Neither the name of the University 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 THE REGENTS 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. + * + * from tahoe: in_cksum.c 1.2 86/01/05 + * from: @(#)in_cksum.c 1.3 (Berkeley) 1/19/91 + * from: Id: in_cksum.c,v 1.8 1995/12/03 18:35:19 bde Exp + */ + +#ifndef _MACHINE_IN_CKSUM_H_ +#define _MACHINE_IN_CKSUM_H_ 1 + +#include <sys/cdefs.h> +#include <netinet/ip.h> /* struct ip */ + +/* + * It it useful to have an Internet checksum routine which is inlineable + * and optimized specifically for the task of computing IP header checksums + * in the normal case (where there are no options and the header length is + * therefore always exactly five 32-bit words. + */ + +/* + * Optimized version for the i386 family + */ + +#if (defined(__GNUC__) && defined(__i386__)) + +static __inline u_int +in_cksum_hdr(const struct ip *ip) +{ + register u_int sum = ((const uint32_t*)ip)[0]; + register u_int tmp; + + __asm__ __volatile__( + " addl %2, %0 \n" + " adcl %3, %0 \n" + " adcl %4, %0 \n" + " adcl %5, %0 \n" + " adcl $0, %0 \n" + " movl %0, %1 \n" + " roll $16, %0 \n" + " addl %1, %0 \n" + :"+&r"(sum),"=&r"(tmp) + :"g"(((const uint32_t*)ip)[1]), + "g"(((const uint32_t*)ip)[2]), + "g"(((const uint32_t*)ip)[3]), + "g"(((const uint32_t*)ip)[4]), + "m"(*ip) + :"cc" + ); + + return (~sum) >>16; +} + +static __inline void +in_cksum_update(struct ip *ip) +{ + int __tmpsum; + __tmpsum = (int)ntohs(ip->ip_sum) + 256; + ip->ip_sum = htons(__tmpsum + (__tmpsum >> 16)); +} + +/* + * Optimized version for the MC68xxx and Coldfire families + */ + +#elif (defined(__GNUC__) && (defined(__mc68000__) || defined(__m68k__))) + +static __inline__ u_int +in_cksum_hdr(const struct ip *ip) +{ + register u_int *ap = (u_int *)ip; + register u_int sum = *ap++; + register u_int tmp; + + __asm__ __volatile__("addl %2@+,%0\n\t" + "movel %2@+,%1\n\t" + "addxl %1,%0\n\t" + "movel %2@+,%1\n\t" + "addxl %1,%0\n\t" + "movel %2@,%1\n\t" + "addxl %1,%0\n\t" + "moveq #0,%1\n\t" + "addxl %1,%0\n" : + "=d" (sum), "=d" (tmp), "=a" (ap) : + "0" (sum), "2" (ap), "m"(*ip)); + sum = (sum & 0xffff) + (sum >> 16); + if (sum > 0xffff) + sum -= 0xffff; + return ~sum & 0xffff; +} + +/* + * Optimized version for the PowerPC family + */ + +#elif (defined(__GNUC__) && (defined(__PPC__) || defined(__ppc__))) + +static __inline u_int +in_cksum_hdr(const struct ip *ip) +{ +register u_int sum, tmp; + __asm__ __volatile__( + " lwz %0, 0(%2) \n" + " lwz %1, 4(%2) \n" + " addc %0, %0, %1 \n" /* generate carry (XER[CA]) */ + " lwz %1, 8(%2) \n" + " adde %0, %0, %1 \n" /* add + generate */ + " lwz %1, 12(%2) \n" + " adde %0, %0, %1 \n" + " lwz %1, 16(%2) \n" + " adde %0, %0, %1 \n" + " addze %0, %0 \n" /* mop up XER[CA] */ + " rotlwi %1, %0,16 \n" /* word-swapped copy in %1 */ + " add %0, %0, %1 \n" /* see comment below */ + " not %0, %0 \n" + " srwi %0, %0, 16 \n" + :"=&r"(sum),"=&r"(tmp):"b"(ip), "m"(*ip):"xer" + ); + /* Note: if 'add' generates a carry out of the lower 16 bits + * then this is automatically added to the upper 16 bits + * where the correct result is found. (Stolen from linux.) + * %0 : upper-word lower-word + * + %1 : lower-word upper-word + * = word-sum word-sum + * ^+inter-word-carry + */ + return sum; +} + +static __inline void +in_cksum_update(struct ip *ip) +{ + int __tmpsum; + __tmpsum = (int)ntohs(ip->ip_sum) + 256; + ip->ip_sum = htons(__tmpsum + (__tmpsum >> 16)); +} + +/* + * SPARC Version + */ + +#elif (defined(__GNUC__) && defined(__sparc__)) + +static __inline u_int +in_cksum_hdr(const struct ip *ip) +{ + register u_int sum = 0; + register u_int tmp_o2; + register u_int tmp_o3; + + __asm__ __volatile__ (" \ + ld [%0], %1 ; \ + ld [%0+4], %2 ; \ + ld [%0+8], %3 ; \ + addcc %1, %2, %1 ; \ + ld [%0+12], %2 ; \ + addxcc %1, %3, %1 ; \ + ld [%0+16], %3 ; \ + addxcc %1, %2, %1 ; \ + addxcc %1, %3, %1 ; \ + set 0x0ffff, %3 ; \ + srl %1, 16, %2 ; \ + and %1, %3, %1 ; \ + addx %1, %2, %1 ; \ + srl %1, 16, %2 ; \ + add %1, %2, %1 ; \ + not %1 ; \ + and %1, %3, %1 ; \ + " : "=r" (ip), "=r" (sum), "=r" (tmp_o2), "=r" (tmp_o3) + : "0" (ip), "1" (sum), "m"(*ip) + ); + return sum; +} + +#define in_cksum_update(ip) \ + do { \ + int __tmpsum; \ + __tmpsum = (int)ntohs(ip->ip_sum) + 256; \ + ip->ip_sum = htons(__tmpsum + (__tmpsum >> 16)); \ + } while(0) + +/* + * Optimized version for the Altera Nios II softcore + */ +#elif defined ( __GNUC__ ) && defined ( __nios2__ ) + +static inline uint32_t _NIOS2_Add_ones_complement ( const uint32_t a, + const uint32_t b ) +{ + uint32_t sum; + uint32_t C; + __asm__ __volatile__ ( + " add %0, %2, %3 \n" /* sum <= a + b */ + " cmpltu %1, %0, %2 \n" /* C <= carryBit32 */ + " add %0, %1, %0 \n" /* sum <= sum + C */ + : "=&r"(sum), "=&r"(C) + : "r"(a), "r"(b) + ); + return sum; +} + +static inline uint16_t _NIOS2_Add_ones_complement_word_halves + ( const uint32_t a ) +{ + uint16_t sum; + uint32_t tmp; + __asm__ __volatile__ ( + " roli %1, %2, 16 \n" /* tmp <= a rotate left 16 */ + " add %1, %2, %1 \n" /* tmp <= a + tmp + carryBit16 */ + " srli %0, %1, 16 \n" /* sum <= tmp shift right 16 */ + : "=&r"(sum),"=&r"(tmp) + : "r"(a) + ); + return sum; +} + +static __inline u_int in_cksum_hdr ( const struct ip * pHdrIP ) +{ + const uint32_t * const pWd = ( const uint32_t * ) pHdrIP; + uint32_t sum = pWd[0]; + sum = _NIOS2_Add_ones_complement ( sum, pWd[1] ); + sum = _NIOS2_Add_ones_complement ( sum, pWd[2] ); + sum = _NIOS2_Add_ones_complement ( sum, pWd[3] ); + sum = _NIOS2_Add_ones_complement ( sum, pWd[4] ); + sum = _NIOS2_Add_ones_complement_word_halves ( sum ); + sum ^= 0xffff; + return sum; +} + +static __inline void in_cksum_update ( struct ip * pHdrIP ) +{ + uint32_t __tmpsum = ntohs ( pHdrIP->ip_sum ); + __tmpsum += 256u; + __tmpsum += __tmpsum >> 16u; + pHdrIP->ip_sum = htons ( ( uint16_t ) __tmpsum ); +} + +/* + * Here is the generic, portable, inefficient algorithm. + */ + +#else +u_int in_cksum_hdr(const struct ip *); +#define in_cksum_update(ip) \ + do { \ + int __tmpsum; \ + __tmpsum = (int)ntohs(ip->ip_sum) + 256; \ + ip->ip_sum = htons(__tmpsum + (__tmpsum >> 16)); \ + } while(0) + +#endif + +#endif /* _MACHINE_IN_CKSUM_H_ */ |