]> git.saurik.com Git - apple/xnu.git/blobdiff - bsd/netinet/in_cksum.c
xnu-1228.7.58.tar.gz
[apple/xnu.git] / bsd / netinet / in_cksum.c
index 4262277c9d70eab4e2e51a45d9fc756b99924f64..28601114c94062ee12222600703dc753abf0e620 100644 (file)
@@ -1,23 +1,29 @@
 /*
- * Copyright (c) 2000 Apple Computer, Inc. All rights reserved.
+ * Copyright (c) 2000-2006 Apple Computer, Inc. All rights reserved.
  *
- * @APPLE_LICENSE_HEADER_START@
+ * @APPLE_OSREFERENCE_LICENSE_HEADER_START@
  * 
- * The contents of this file constitute Original Code as defined in and
- * are subject to the Apple Public Source License Version 1.1 (the
- * "License").  You may not use this file except in compliance with the
- * License.  Please obtain a copy of the License at
- * http://www.apple.com/publicsource and read it before using this file.
+ * This file contains Original Code and/or Modifications of Original Code
+ * as defined in and that are subject to the Apple Public Source License
+ * Version 2.0 (the 'License'). You may not use this file except in
+ * compliance with the License. The rights granted to you under the License
+ * may not be used to create, or enable the creation or redistribution of,
+ * unlawful or unlicensed copies of an Apple operating system, or to
+ * circumvent, violate, or enable the circumvention or violation of, any
+ * terms of an Apple operating system software license agreement.
  * 
- * This Original Code and all software distributed under the License are
- * distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY KIND, EITHER
+ * Please obtain a copy of the License at
+ * http://www.opensource.apple.com/apsl/ and read it before using this file.
+ * 
+ * The Original Code and all software distributed under the License are
+ * distributed on an 'AS IS' basis, WITHOUT WARRANTY OF ANY KIND, EITHER
  * EXPRESS OR IMPLIED, AND APPLE HEREBY DISCLAIMS ALL SUCH WARRANTIES,
  * INCLUDING WITHOUT LIMITATION, ANY WARRANTIES OF MERCHANTABILITY,
- * FITNESS FOR A PARTICULAR PURPOSE OR NON-INFRINGEMENT.  Please see the
- * License for the specific language governing rights and limitations
- * under the License.
+ * FITNESS FOR A PARTICULAR PURPOSE, QUIET ENJOYMENT OR NON-INFRINGEMENT.
+ * Please see the License for the specific language governing rights and
+ * limitations under the License.
  * 
- * @APPLE_LICENSE_HEADER_END@
+ * @APPLE_OSREFERENCE_LICENSE_HEADER_END@
  */
 /*
  * Copyright (c) 1988, 1992, 1993
@@ -57,6 +63,9 @@
 #include <sys/param.h>
 #include <sys/mbuf.h>
 #include <sys/kdebug.h>
+#include <kern/debug.h>
+#include <netinet/in.h>
+#include <netinet/ip.h>
 
 #define DBG_FNC_IN_CKSUM       NETDBG_CODE(DBG_NETIP, (3 << 8))
 
  * code and should be modified for each CPU to be as fast as possible.
  */
 
+union s_util {
+        char    c[2];
+        u_short s;
+};
+
+union l_util {
+        u_int16_t s[2];
+        u_int32_t l;
+};
 
+union q_util {
+        u_int16_t s[4];
+        u_int32_t l[2];
+        u_int64_t q;
+};
+
+#define ADDCARRY(x)  (x > 65535 ? x -= 65535 : x)
+
+#define REDUCE32                                                          \
+    {                                                                     \
+        q_util.q = sum;                                                   \
+        sum = q_util.s[0] + q_util.s[1] + q_util.s[2] + q_util.s[3];      \
+    }
+#define REDUCE16                                                          \
+    {                                                                     \
+        q_util.q = sum;                                                   \
+        l_util.l = q_util.s[0] + q_util.s[1] + q_util.s[2] + q_util.s[3]; \
+        sum = l_util.s[0] + l_util.s[1];                                  \
+        ADDCARRY(sum);                                                    \
+    }
+
+#define REDUCE {l_util.l = sum; sum = l_util.s[0] + l_util.s[1]; ADDCARRY(sum);}
 
-#if defined(ppc)
+u_int16_t inet_cksum_simple(struct mbuf *, int);
 
-int
-in_cksum(m, len)
-       register struct mbuf *m;
-       register int len;
+u_int16_t
+inet_cksum_simple(struct mbuf *m, int len)
 {
-       register u_short *w;
-       register int sum = 0;
-       register int mlen = 0;
-       int starting_on_odd  = 0;
+       return (inet_cksum(m, 0, 0, len));
+}
+
+#if defined(__ppc__)
+
+extern u_short xsum_assym(u_short *p, int len, u_short xsum, int odd);
+
+inline u_short
+in_addword(u_short a, u_short b)
+{
+        union l_util l_util;
+       u_int32_t sum = a + b;
 
+       REDUCE;
+       return (sum);
+}
+
+inline u_short
+in_pseudo(u_int a, u_int b, u_int c)
+{
+        u_int64_t sum;
+        union q_util q_util;
+        union l_util l_util;
+
+        sum = (u_int64_t) a + b + c;
+        REDUCE16;
+        return (sum);
+
+}
+
+u_int16_t
+inet_cksum(struct mbuf *m, unsigned int nxt, unsigned int skip,
+    unsigned int len)
+{
+       u_short *w;
+       u_int32_t sum = 0;
+       int mlen = 0;
+       int starting_on_odd  = 0;
 
        KERNEL_DEBUG(DBG_FNC_IN_CKSUM | DBG_FUNC_START, len,0,0,0,0);
 
+       /* sanity check */
+       if (m->m_pkthdr.len < skip + len) {
+               panic("inet_cksum: mbuf len (%d) < off+len (%d+%d)\n",
+                   m->m_pkthdr.len, skip, len);
+       }
+
+       /* include pseudo header checksum? */
+       if (nxt != 0) {
+               struct ip *iph;
+
+               if (m->m_len < sizeof (struct ip))
+                       panic("inet_cksum: bad mbuf chain");
+
+               iph = mtod(m, struct ip *);
+               sum = in_pseudo(iph->ip_src.s_addr, iph->ip_dst.s_addr,
+                   htonl(len + nxt));
+       }
+
+       if (skip != 0) {
+               for (; skip && m; m = m->m_next) {
+                       if (m->m_len > skip) {
+                               mlen = m->m_len - skip;
+                               w = (u_short *)(m->m_data+skip);
+                               goto skip_start;
+                       } else {
+                               skip -= m->m_len;
+                       }
+               }
+       }
+
        for (;m && len; m = m->m_next) {
                if (m->m_len == 0)
                        continue;
                mlen = m->m_len;
                w = mtod(m, u_short *);
 
+skip_start:
                if (len < mlen)
                        mlen = len;
-
                sum = xsum_assym(w, mlen, sum, starting_on_odd);
                len -= mlen;
                if (mlen & 0x1)
@@ -105,42 +206,81 @@ in_cksum(m, len)
        }
 
        KERNEL_DEBUG(DBG_FNC_IN_CKSUM | DBG_FUNC_END, 0,0,0,0,0);
+
        return (~sum & 0xffff);
 }
 
 #else
 
+inline u_short
+in_addword(u_short a, u_short b)
+{
+        union l_util l_util;
+        u_int32_t sum = a + b;
 
-#define ADDCARRY(x)  (x > 65535 ? x -= 65535 : x)
-#define REDUCE {l_util.l = sum; sum = l_util.s[0] + l_util.s[1]; ADDCARRY(sum);}
+        REDUCE(sum);
+        return (sum);
+}
 
+inline u_short
+in_pseudo(u_int a, u_int b, u_int c)
+{
+        u_int64_t sum;
+        union q_util q_util;
+        union l_util l_util;
 
+        sum = (u_int64_t) a + b + c;
+        REDUCE16;
+        return (sum);
+}
 
-int
-in_cksum(m, len)
-       register struct mbuf *m;
-       register int len;
+u_int16_t
+inet_cksum(struct mbuf *m, unsigned int nxt, unsigned int skip,
+    unsigned int len)
 {
-       register u_short *w;
-       register int sum = 0;
-       register int mlen = 0;
+       u_short *w;
+       u_int32_t sum = 0;
+       int mlen = 0;
        int byte_swapped = 0;
-
-       union {
-               char    c[2];
-               u_short s;
-       } s_util;
-       union {
-               u_short s[2];
-               long    l;
-       } l_util;
+       union s_util s_util;
+       union l_util l_util;
 
        KERNEL_DEBUG(DBG_FNC_IN_CKSUM | DBG_FUNC_START, len,0,0,0,0);
 
+       /* sanity check */
+       if (m->m_pkthdr.len < skip + len) {
+               panic("inet_cksum: mbuf len (%d) < off+len (%d+%d)\n",
+                   m->m_pkthdr.len, skip, len);
+       }
+
+       /* include pseudo header checksum? */
+       if (nxt != 0) {
+               struct ip *iph;
+
+               if (m->m_len < sizeof (struct ip))
+                       panic("inet_cksum: bad mbuf chain");
+
+               iph = mtod(m, struct ip *);
+               sum = in_pseudo(iph->ip_src.s_addr, iph->ip_dst.s_addr,
+                   htonl(len + nxt));
+       }
+
+       if (skip != 0) {
+               for (; skip && m; m = m->m_next) {
+                       if (m->m_len > skip) {
+                               mlen = m->m_len - skip;
+                               w = (u_short *)(m->m_data+skip);
+                               goto skip_start;
+                       } else {
+                               skip -= m->m_len;
+                       }
+               }
+       }
        for (;m && len; m = m->m_next) {
                if (m->m_len == 0)
                        continue;
                w = mtod(m, u_short *);
+
                if (mlen == -1) {
                        /*
                         * The first byte of this mbuf is the continuation
@@ -155,10 +295,13 @@ in_cksum(m, len)
                        w = (u_short *)((char *)w + 1);
                        mlen = m->m_len - 1;
                        len--;
-               } else
+               } else {
                        mlen = m->m_len;
+               }
+skip_start:
                if (len < mlen)
                        mlen = len;
+
                len -= mlen;
                /*
                 * Force to even boundary.
@@ -208,7 +351,7 @@ in_cksum(m, len)
                        s_util.c[0] = *(char *)w;
        }
        if (len)
-               printf("cksum: out of data\n");
+               printf("cksum: out of data by %d\n", len);
        if (mlen == -1) {
                /* The last mbuf has odd # of bytes. Follow the
                   standard (the odd byte may be shifted left by 8 bits