[BACK]Return to in6_cksum.c CVS log [TXT][DIR] Up to [local] / sys / netinet6

Annotation of sys/netinet6/in6_cksum.c, Revision 1.1.1.1

1.1       nbrk        1: /*     $OpenBSD: in6_cksum.c,v 1.14 2006/11/17 01:11:23 itojun Exp $   */
                      2: /*     $KAME: in6_cksum.c,v 1.10 2000/12/03 00:53:59 itojun Exp $      */
                      3:
                      4: /*
                      5:  * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project.
                      6:  * All rights reserved.
                      7:  *
                      8:  * Redistribution and use in source and binary forms, with or without
                      9:  * modification, are permitted provided that the following conditions
                     10:  * are met:
                     11:  * 1. Redistributions of source code must retain the above copyright
                     12:  *    notice, this list of conditions and the following disclaimer.
                     13:  * 2. Redistributions in binary form must reproduce the above copyright
                     14:  *    notice, this list of conditions and the following disclaimer in the
                     15:  *    documentation and/or other materials provided with the distribution.
                     16:  * 3. Neither the name of the project nor the names of its contributors
                     17:  *    may be used to endorse or promote products derived from this software
                     18:  *    without specific prior written permission.
                     19:  *
                     20:  * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
                     21:  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
                     22:  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
                     23:  * ARE DISCLAIMED.  IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
                     24:  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
                     25:  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
                     26:  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
                     27:  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
                     28:  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
                     29:  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
                     30:  * SUCH DAMAGE.
                     31:  */
                     32:
                     33: /*
                     34:  * Copyright (c) 1988, 1992, 1993
                     35:  *     The Regents of the University of California.  All rights reserved.
                     36:  *
                     37:  * Redistribution and use in source and binary forms, with or without
                     38:  * modification, are permitted provided that the following conditions
                     39:  * are met:
                     40:  * 1. Redistributions of source code must retain the above copyright
                     41:  *    notice, this list of conditions and the following disclaimer.
                     42:  * 2. Redistributions in binary form must reproduce the above copyright
                     43:  *    notice, this list of conditions and the following disclaimer in the
                     44:  *    documentation and/or other materials provided with the distribution.
                     45:  * 3. Neither the name of the University nor the names of its contributors
                     46:  *    may be used to endorse or promote products derived from this software
                     47:  *    without specific prior written permission.
                     48:  *
                     49:  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
                     50:  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
                     51:  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
                     52:  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
                     53:  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
                     54:  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
                     55:  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
                     56:  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
                     57:  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
                     58:  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
                     59:  * SUCH DAMAGE.
                     60:  *
                     61:  *     @(#)in_cksum.c  8.1 (Berkeley) 6/10/93
                     62:  */
                     63:
                     64: #include <sys/param.h>
                     65: #include <sys/mbuf.h>
                     66: #include <sys/systm.h>
                     67: #include <netinet/in.h>
                     68: #include <netinet/ip6.h>
                     69:
                     70: /*
                     71:  * Checksum routine for Internet Protocol family headers (Portable Version).
                     72:  *
                     73:  * This routine is very heavily used in the network
                     74:  * code and should be modified for each CPU to be as fast as possible.
                     75:  */
                     76:
                     77: #define ADDCARRY(x)  (x > 65535 ? x -= 65535 : x)
                     78: #define REDUCE {l_util.l = sum; sum = l_util.s[0] + l_util.s[1]; ADDCARRY(sum);}
                     79:
                     80: /*
                     81:  * m MUST contain a continuous IP6 header.
                     82:  * off is a offset where TCP/UDP/ICMP6 header starts.
                     83:  * len is a total length of a transport segment.
                     84:  * (e.g. TCP header + TCP payload)
                     85:  */
                     86:
                     87: int
                     88: in6_cksum(m, nxt, off, len)
                     89:        struct mbuf *m;
                     90:        u_int8_t nxt;
                     91:        u_int32_t off, len;
                     92: {
                     93:        u_int16_t *w;
                     94:        int sum = 0;
                     95:        int mlen = 0;
                     96:        int byte_swapped = 0;
                     97:        struct ip6_hdr *ip6;
                     98:        union {
                     99:                u_int16_t phs[4];
                    100:                struct {
                    101:                        u_int32_t       ph_len;
                    102:                        u_int8_t        ph_zero[3];
                    103:                        u_int8_t        ph_nxt;
                    104:                } ph __packed;
                    105:        } uph;
                    106:        union {
                    107:                u_int8_t        c[2];
                    108:                u_int16_t       s;
                    109:        } s_util;
                    110:        union {
                    111:                u_int16_t s[2];
                    112:                u_int32_t l;
                    113:        } l_util;
                    114:
                    115:        /* sanity check */
                    116:        if (m->m_pkthdr.len < off + len) {
                    117:                panic("in6_cksum: mbuf len (%d) < off+len (%d+%d)",
                    118:                        m->m_pkthdr.len, off, len);
                    119:        }
                    120:
                    121:        bzero(&uph, sizeof(uph));
                    122:
                    123:        /*
                    124:         * First create IP6 pseudo header and calculate a summary.
                    125:         */
                    126:        ip6 = mtod(m, struct ip6_hdr *);
                    127:        w = (u_int16_t *)&ip6->ip6_src;
                    128:        uph.ph.ph_len = htonl(len);
                    129:        uph.ph.ph_nxt = nxt;
                    130:
                    131:        /* IPv6 source address */
                    132:        sum += w[0];
                    133:        if (!IN6_IS_SCOPE_EMBED(&ip6->ip6_src))
                    134:                sum += w[1];
                    135:        sum += w[2]; sum += w[3]; sum += w[4]; sum += w[5];
                    136:        sum += w[6]; sum += w[7];
                    137:        /* IPv6 destination address */
                    138:        sum += w[8];
                    139:        if (!IN6_IS_SCOPE_EMBED(&ip6->ip6_dst))
                    140:                sum += w[9];
                    141:        sum += w[10]; sum += w[11]; sum += w[12]; sum += w[13];
                    142:        sum += w[14]; sum += w[15];
                    143:        /* Payload length and upper layer identifier */
                    144:        sum += uph.phs[0];  sum += uph.phs[1];
                    145:        sum += uph.phs[2];  sum += uph.phs[3];
                    146:
                    147:        /*
                    148:         * Secondly calculate a summary of the first mbuf excluding offset.
                    149:         */
                    150:        while (m != NULL && off > 0) {
                    151:                if (m->m_len <= off)
                    152:                        off -= m->m_len;
                    153:                else
                    154:                        break;
                    155:                m = m->m_next;
                    156:        }
                    157:        w = (u_int16_t *)(mtod(m, u_char *) + off);
                    158:        mlen = m->m_len - off;
                    159:        if (len < mlen)
                    160:                mlen = len;
                    161:        len -= mlen;
                    162:        /*
                    163:         * Force to even boundary.
                    164:         */
                    165:        if ((1 & (long) w) && (mlen > 0)) {
                    166:                REDUCE;
                    167:                sum <<= 8;
                    168:                s_util.c[0] = *(u_char *)w;
                    169:                w = (u_int16_t *)((char *)w + 1);
                    170:                mlen--;
                    171:                byte_swapped = 1;
                    172:        }
                    173:        /*
                    174:         * Unroll the loop to make overhead from
                    175:         * branches &c small.
                    176:         */
                    177:        while ((mlen -= 32) >= 0) {
                    178:                sum += w[0]; sum += w[1]; sum += w[2]; sum += w[3];
                    179:                sum += w[4]; sum += w[5]; sum += w[6]; sum += w[7];
                    180:                sum += w[8]; sum += w[9]; sum += w[10]; sum += w[11];
                    181:                sum += w[12]; sum += w[13]; sum += w[14]; sum += w[15];
                    182:                w += 16;
                    183:        }
                    184:        mlen += 32;
                    185:        while ((mlen -= 8) >= 0) {
                    186:                sum += w[0]; sum += w[1]; sum += w[2]; sum += w[3];
                    187:                w += 4;
                    188:        }
                    189:        mlen += 8;
                    190:        if (mlen == 0 && byte_swapped == 0)
                    191:                goto next;
                    192:        REDUCE;
                    193:        while ((mlen -= 2) >= 0) {
                    194:                sum += *w++;
                    195:        }
                    196:        if (byte_swapped) {
                    197:                REDUCE;
                    198:                sum <<= 8;
                    199:                byte_swapped = 0;
                    200:                if (mlen == -1) {
                    201:                        s_util.c[1] = *(char *)w;
                    202:                        sum += s_util.s;
                    203:                        mlen = 0;
                    204:                } else
                    205:                        mlen = -1;
                    206:        } else if (mlen == -1)
                    207:                s_util.c[0] = *(char *)w;
                    208:  next:
                    209:        m = m->m_next;
                    210:
                    211:        /*
                    212:         * Lastly calculate a summary of the rest of mbufs.
                    213:         */
                    214:
                    215:        for (;m && len; m = m->m_next) {
                    216:                if (m->m_len == 0)
                    217:                        continue;
                    218:                w = mtod(m, u_int16_t *);
                    219:                if (mlen == -1) {
                    220:                        /*
                    221:                         * The first byte of this mbuf is the continuation
                    222:                         * of a word spanning between this mbuf and the
                    223:                         * last mbuf.
                    224:                         *
                    225:                         * s_util.c[0] is already saved when scanning previous
                    226:                         * mbuf.
                    227:                         */
                    228:                        s_util.c[1] = *(char *)w;
                    229:                        sum += s_util.s;
                    230:                        w = (u_int16_t *)((char *)w + 1);
                    231:                        mlen = m->m_len - 1;
                    232:                        len--;
                    233:                } else
                    234:                        mlen = m->m_len;
                    235:                if (len < mlen)
                    236:                        mlen = len;
                    237:                len -= mlen;
                    238:                /*
                    239:                 * Force to even boundary.
                    240:                 */
                    241:                if ((1 & (long) w) && (mlen > 0)) {
                    242:                        REDUCE;
                    243:                        sum <<= 8;
                    244:                        s_util.c[0] = *(u_char *)w;
                    245:                        w = (u_int16_t *)((char *)w + 1);
                    246:                        mlen--;
                    247:                        byte_swapped = 1;
                    248:                }
                    249:                /*
                    250:                 * Unroll the loop to make overhead from
                    251:                 * branches &c small.
                    252:                 */
                    253:                while ((mlen -= 32) >= 0) {
                    254:                        sum += w[0]; sum += w[1]; sum += w[2]; sum += w[3];
                    255:                        sum += w[4]; sum += w[5]; sum += w[6]; sum += w[7];
                    256:                        sum += w[8]; sum += w[9]; sum += w[10]; sum += w[11];
                    257:                        sum += w[12]; sum += w[13]; sum += w[14]; sum += w[15];
                    258:                        w += 16;
                    259:                }
                    260:                mlen += 32;
                    261:                while ((mlen -= 8) >= 0) {
                    262:                        sum += w[0]; sum += w[1]; sum += w[2]; sum += w[3];
                    263:                        w += 4;
                    264:                }
                    265:                mlen += 8;
                    266:                if (mlen == 0 && byte_swapped == 0)
                    267:                        continue;
                    268:                REDUCE;
                    269:                while ((mlen -= 2) >= 0) {
                    270:                        sum += *w++;
                    271:                }
                    272:                if (byte_swapped) {
                    273:                        REDUCE;
                    274:                        sum <<= 8;
                    275:                        byte_swapped = 0;
                    276:                        if (mlen == -1) {
                    277:                                s_util.c[1] = *(char *)w;
                    278:                                sum += s_util.s;
                    279:                                mlen = 0;
                    280:                        } else
                    281:                                mlen = -1;
                    282:                } else if (mlen == -1)
                    283:                        s_util.c[0] = *(char *)w;
                    284:        }
                    285:        if (len)
                    286:                panic("in6_cksum: out of data");
                    287:        if (mlen == -1) {
                    288:                /* The last mbuf has odd # of bytes. Follow the
                    289:                   standard (the odd byte may be shifted left by 8 bits
                    290:                   or not as determined by endian-ness of the machine) */
                    291:                s_util.c[1] = 0;
                    292:                sum += s_util.s;
                    293:        }
                    294:        REDUCE;
                    295:        return (~sum & 0xffff);
                    296: }

CVSweb