Home | History | Annotate | Line # | Download | only in netinet6
dest6.c revision 1.2
      1  1.2  itojun /*
      2  1.2  itojun  * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project.
      3  1.2  itojun  * All rights reserved.
      4  1.2  itojun  *
      5  1.2  itojun  * Redistribution and use in source and binary forms, with or without
      6  1.2  itojun  * modification, are permitted provided that the following conditions
      7  1.2  itojun  * are met:
      8  1.2  itojun  * 1. Redistributions of source code must retain the above copyright
      9  1.2  itojun  *    notice, this list of conditions and the following disclaimer.
     10  1.2  itojun  * 2. Redistributions in binary form must reproduce the above copyright
     11  1.2  itojun  *    notice, this list of conditions and the following disclaimer in the
     12  1.2  itojun  *    documentation and/or other materials provided with the distribution.
     13  1.2  itojun  * 3. Neither the name of the project nor the names of its contributors
     14  1.2  itojun  *    may be used to endorse or promote products derived from this software
     15  1.2  itojun  *    without specific prior written permission.
     16  1.2  itojun  *
     17  1.2  itojun  * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
     18  1.2  itojun  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     19  1.2  itojun  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     20  1.2  itojun  * ARE DISCLAIMED.  IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
     21  1.2  itojun  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     22  1.2  itojun  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     23  1.2  itojun  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     24  1.2  itojun  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     25  1.2  itojun  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     26  1.2  itojun  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     27  1.2  itojun  * SUCH DAMAGE.
     28  1.2  itojun  */
     29  1.2  itojun 
     30  1.2  itojun #include <sys/param.h>
     31  1.2  itojun #include <sys/systm.h>
     32  1.2  itojun #include <sys/malloc.h>
     33  1.2  itojun #include <sys/mbuf.h>
     34  1.2  itojun #include <sys/domain.h>
     35  1.2  itojun #include <sys/protosw.h>
     36  1.2  itojun #include <sys/socket.h>
     37  1.2  itojun #include <sys/errno.h>
     38  1.2  itojun #include <sys/time.h>
     39  1.2  itojun #include <sys/kernel.h>
     40  1.2  itojun 
     41  1.2  itojun #include <net/if.h>
     42  1.2  itojun #include <net/route.h>
     43  1.2  itojun 
     44  1.2  itojun #include <netinet/in.h>
     45  1.2  itojun #include <netinet/in_var.h>
     46  1.2  itojun #include <netinet6/in6_systm.h>
     47  1.2  itojun #include <netinet6/ip6.h>
     48  1.2  itojun #if !defined(__FreeBSD__) || __FreeBSD__ < 3
     49  1.2  itojun #include <netinet6/in6_pcb.h>
     50  1.2  itojun #endif
     51  1.2  itojun #include <netinet6/ip6_var.h>
     52  1.2  itojun #include <netinet6/icmp6.h>
     53  1.2  itojun 
     54  1.2  itojun /*
     55  1.2  itojun  * Destination options header processing.
     56  1.2  itojun  */
     57  1.2  itojun int
     58  1.2  itojun dest6_input(mp, offp, proto)
     59  1.2  itojun 	struct mbuf **mp;
     60  1.2  itojun 	int *offp, proto;
     61  1.2  itojun {
     62  1.2  itojun 	register struct mbuf *m = *mp;
     63  1.2  itojun 	int off = *offp, dstoptlen, optlen;
     64  1.2  itojun 	struct ip6_dest *dstopts;
     65  1.2  itojun 	u_int8_t *opt;
     66  1.2  itojun 
     67  1.2  itojun 	/* validation of the length of the header */
     68  1.2  itojun 	IP6_EXTHDR_CHECK(m, off, sizeof(*dstopts), IPPROTO_DONE);
     69  1.2  itojun 	dstopts = (struct ip6_dest *)(mtod(m, caddr_t) + off);
     70  1.2  itojun 	dstoptlen = (dstopts->ip6d_len + 1) << 3;
     71  1.2  itojun 
     72  1.2  itojun 	IP6_EXTHDR_CHECK(m, off, dstoptlen, IPPROTO_DONE);
     73  1.2  itojun 	dstopts = (struct ip6_dest *)(mtod(m, caddr_t) + off);
     74  1.2  itojun 	off += dstoptlen;
     75  1.2  itojun 	dstoptlen -= sizeof(struct ip6_dest);
     76  1.2  itojun 	opt = (u_int8_t *)dstopts + sizeof(struct ip6_dest);
     77  1.2  itojun 
     78  1.2  itojun 	/* search header for all options. */
     79  1.2  itojun 	for (optlen = 0; dstoptlen > 0; dstoptlen -= optlen, opt += optlen) {
     80  1.2  itojun 		switch(*opt) {
     81  1.2  itojun 		 case IP6OPT_PAD1:
     82  1.2  itojun 			 optlen = 1;
     83  1.2  itojun 			 break;
     84  1.2  itojun 		 case IP6OPT_PADN:
     85  1.2  itojun 			 if (dstoptlen < IP6OPT_MINLEN) {
     86  1.2  itojun 				 ip6stat.ip6s_toosmall++;
     87  1.2  itojun 				 goto bad;
     88  1.2  itojun 			 }
     89  1.2  itojun 			 optlen = *(opt + 1) + 2;
     90  1.2  itojun 			 break;
     91  1.2  itojun 		 default:		/* unknown option */
     92  1.2  itojun 			 if (dstoptlen < IP6OPT_MINLEN) {
     93  1.2  itojun 				 ip6stat.ip6s_toosmall++;
     94  1.2  itojun 				 goto bad;
     95  1.2  itojun 			 }
     96  1.2  itojun 			 if ((optlen = ip6_unknown_opt(opt, m,
     97  1.2  itojun 						       opt-mtod(m, u_int8_t *))) == -1)
     98  1.2  itojun 				 return(IPPROTO_DONE);
     99  1.2  itojun 			 optlen += 2;
    100  1.2  itojun 			 break;
    101  1.2  itojun 		}
    102  1.2  itojun 	}
    103  1.2  itojun 
    104  1.2  itojun 	*offp = off;
    105  1.2  itojun 	return(dstopts->ip6d_nxt);
    106  1.2  itojun 
    107  1.2  itojun   bad:
    108  1.2  itojun 	m_freem(m);
    109  1.2  itojun 	return(IPPROTO_DONE);
    110  1.2  itojun }
    111