sys/arm/arm/in_cksum.c

   1 /* $NetBSD: in_cksum.c,v 1.7 1997/09/02 13:18:15 thorpej Exp $ */
   2
   3 /*-
   4  * Copyright (c) 1988, 1992, 1993
   5  *      The Regents of the University of California.  All rights reserved.
   6  * Copyright (c) 1996
   7  *      Matt Thomas <matt@3am-software.com>
   8  *
   9  * Redistribution and use in source and binary forms, with or without
  10  * modification, are permitted provided that the following conditions
  11  * are met:
  12  * 1. Redistributions of source code must retain the above copyright
  13  *    notice, this list of conditions and the following disclaimer.
  14  * 2. Redistributions in binary form must reproduce the above copyright
  15  *    notice, this list of conditions and the following disclaimer in the
  16  *    documentation and/or other materials provided with the distribution.
  17  * 3. All advertising materials mentioning features or use of this software
  18  *    must display the following acknowledgement:
  19  *      This product includes software developed by the University of
  20  *      California, Berkeley and its contributors.
  21  * 4. Neither the name of the University nor the names of its contributors
  22  *    may be used to endorse or promote products derived from this software
  23  *    without specific prior written permission.
  24  *
  25  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
  26  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  27  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  28  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
  29  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  30  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  31  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  32  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  33  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  34  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  35  * SUCH DAMAGE.
  36  *
  37  *      @(#)in_cksum.c  8.1 (Berkeley) 6/10/93
  38  */
  39
  40 #include <sys/cdefs.h>                  /* RCS ID & Copyright macro defns */
  41 __FBSDID("$FreeBSD$");
  42
  43 #include <sys/param.h>
  44 #include <sys/mbuf.h>
  45 #include <sys/systm.h>
  46 #include <netinet/in_systm.h>
  47 #include <netinet/in.h>
  48 #include <netinet/ip.h>
  49 #include <machine/in_cksum.h>
  50
  51 /*
  52  * Checksum routine for Internet Protocol family headers
  53  *    (Portable Alpha version).
  54  *
  55  * This routine is very heavily used in the network
  56  * code and should be modified for each CPU to be as fast as possible.
  57  */
  58
  59 #define ADDCARRY(x)  (x > 65535 ? x -= 65535 : x)
  60 #define REDUCE32                                                          \
  61     {                                                                     \
  62         q_util.q = sum;                                                   \
  63         sum = q_util.s[0] + q_util.s[1] + q_util.s[2] + q_util.s[3];      \
  64     }
  65 #define REDUCE16                                                          \
  66     {                                                                     \
  67         q_util.q = sum;                                                   \
  68         l_util.l = q_util.s[0] + q_util.s[1] + q_util.s[2] + q_util.s[3]; \
  69         sum = l_util.s[0] + l_util.s[1];                                  \
  70         ADDCARRY(sum);                                                    \
  71     }
  72
  73 union l_util {
  74         u_int16_t s[2];
  75         u_int32_t l;
  76 };
  77 union q_util {
  78         u_int16_t s[4];
  79         u_int32_t l[2];
  80         u_int64_t q;
  81 };
  82
  83 u_short
  84 in_addword(u_short a, u_short b)
  85 {
  86         u_int64_t sum = a + b;
  87
  88         ADDCARRY(sum);
  89         return (sum);
  90 }
  91
  92 static
  93 uint64_t _do_cksum(void *addr, int len)
  94 {
  95         uint64_t sum;
  96         union q_util q_util;
  97
  98         sum = do_cksum(addr, len);
  99         REDUCE32;
 100         return (sum);
 101 }
 102
 103 u_short
 104 in_cksum_skip(struct mbuf *m, int len, int skip)
 105 {
 106         u_int64_t sum = 0;
 107         int mlen = 0;
 108         int clen = 0;
 109         caddr_t addr;
 110         union q_util q_util;
 111         union l_util l_util;
 112
 113         len -= skip;
 114         for (; skip && m; m = m->m_next) {
 115                 if (m->m_len > skip) {
 116                         mlen = m->m_len - skip;
 117                         addr = mtod(m, caddr_t) + skip;
 118                         goto skip_start;
 119                 } else {
 120                         skip -= m->m_len;
 121                 }
 122         }
 123
 124         for (; m && len; m = m->m_next) {
 125                 if (m->m_len == 0)
 126                         continue;
 127                 mlen = m->m_len;
 128                 addr = mtod(m, caddr_t);
 129 skip_start:
 130                 if (len < mlen)
 131                         mlen = len;
 132
 133                 if ((clen ^ (int) addr) & 1)
 134                     sum += _do_cksum(addr, mlen) << 8;
 135                 else
 136                     sum += _do_cksum(addr, mlen);
 137
 138                 clen += mlen;
 139                 len -= mlen;
 140         }
 141         REDUCE16;
 142         return (~sum & 0xffff);
 143 }
 144
 145 u_int in_cksum_hdr(const struct ip *ip)
 146 {
 147         u_int64_t sum = do_cksum(ip, sizeof(struct ip));
 148         union q_util q_util;
 149         union l_util l_util;
 150         REDUCE16;
 151         return (~sum & 0xffff);
 152 }