[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     ! 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