Home | History | Annotate | Line # | Download | only in netinet6
in6_cksum.c revision 1.25 
      1 /*	$NetBSD: in6_cksum.c,v 1.25 2008/03/09 22:05:50 yamt Exp $	*/
      2 
      3 /*-
      4  * Copyright (c) 2008 Joerg Sonnenberger <joerg (at) NetBSD.org>.
      5  * All rights reserved.
      6  *
      7  * Redistribution and use in source and binary forms, with or without
      8  * modification, are permitted provided that the following conditions
      9  * are met:
     10  *
     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
     15  *    the documentation and/or other materials provided with the
     16  *    distribution.
     17  *
     18  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
     19  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
     20  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
     21  * FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE
     22  * COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
     23  * INCIDENTAL, SPECIAL, EXEMPLARY OR CONSEQUENTIAL DAMAGES (INCLUDING,
     24  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
     25  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
     26  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
     27  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
     28  * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     29  * SUCH DAMAGE.
     30  */
     31 
     32 #include <sys/cdefs.h>
     33 __KERNEL_RCSID(0, "$NetBSD: in6_cksum.c,v 1.25 2008/03/09 22:05:50 yamt Exp $");
     34 
     35 #include <sys/param.h>
     36 #include <sys/mbuf.h>
     37 #include <netinet/in.h>
     38 #include <netinet/ip6.h>
     39 
     40 /*
     41  * Checksum of the IPv6 pseudo header.
     42  *
     43  * off is supposed to be the skipped IPv6 header, len is the payload size.
     44  */
     45 
     46 int
     47 in6_cksum(struct mbuf *m, u_int8_t nxt, uint32_t off, uint32_t len)
     48 {
     49 	union {
     50 		uint16_t words[16];
     51 		struct {
     52 			struct in6_addr ip6_src;
     53 			struct in6_addr ip6_dst;
     54 		} addrs;
     55 	} u;
     56 	const struct in6_addr *in6_src;
     57 	const struct in6_addr *in6_dst;
     58 	const struct ip6_hdr *ip6;
     59 	uint32_t sum;
     60 	const uint16_t *w;
     61 
     62 	if (__predict_false(off < sizeof(struct ip6_hdr)))
     63 		panic("in6_cksum: offset too short for IPv6 header");
     64 	if (__predict_false(m->m_len < sizeof(struct ip6_hdr)))
     65 		panic("in6_cksum: mbuf too short for IPv6 header");
     66 
     67 	if (nxt == 0)
     68 		return cpu_in_cksum(m, len, off, 0);
     69 
     70 	/*
     71 	 * Compute the equivalent of:
     72 	 * struct ip6_hdr_pseudo ip6;
     73 	 *
     74 	 * bzero(sizeof(*ip6));
     75 	 * ip6.ip6ph_nxt = nxt;
     76 	 * ip6.ip6ph_len = htonl(len);
     77 	 * ipv6.ip6ph_src = mtod(m, struct ip6_hdr *)->ip6_src;
     78 	 * in6_clearscope(&ip6->ip6ph_src);
     79 	 * ipv6.ip6ph_dst = mtod(m, struct ip6_hdr *)->ip6_dst;
     80 	 * in6_clearscope(&ip6->ip6ph_dst);
     81 	 * sum = one_add(&ip6);
     82 	 */
     83 
     84 #if BYTE_ORDER == LITTLE_ENDIAN
     85 	sum = ((len & 0xffff) + ((len >> 16) & 0xffff) + nxt) << 8;
     86 #else
     87 	sum = (len & 0xffff) + ((len >> 16) & 0xffff) + nxt;
     88 #endif
     89 	ip6 = mtod(m, const struct ip6_hdr *);
     90 	w = (const uint16_t *)(const void *)&ip6->ip6_src;
     91 	if (__predict_true((uintptr_t)w % 2 == 0)) {
     92 		in6_src = &ip6->ip6_src;
     93 		in6_dst = &ip6->ip6_dst;
     94 	} else {
     95 		memcpy(&u, &ip6->ip6_src, 32);
     96 		w = u.words;
     97 		in6_src = &u.addrs.ip6_src;
     98 		in6_dst = &u.addrs.ip6_dst;
     99 	}
    100 
    101 	sum += w[0];
    102 	if (!IN6_IS_SCOPE_LINKLOCAL(in6_src) &&
    103 	    !IN6_IS_ADDR_MC_INTFACELOCAL(in6_src))
    104 		sum += w[1];
    105 	sum += w[2];
    106 	sum += w[3];
    107 	sum += w[4];
    108 	sum += w[5];
    109 	sum += w[6];
    110 	sum += w[7];
    111 	w += 8;
    112 	sum += w[0];
    113 	if (!IN6_IS_SCOPE_LINKLOCAL(in6_dst) &&
    114 	    !IN6_IS_ADDR_MC_INTFACELOCAL(in6_dst))
    115 		sum += w[1];
    116 	sum += w[2];
    117 	sum += w[3];
    118 	sum += w[4];
    119 	sum += w[5];
    120 	sum += w[6];
    121 	sum += w[7];
    122 
    123 	return cpu_in_cksum(m, len, off, sum);
    124 }
    125