Home | History | Annotate | Line # | Download | only in netinet
ip_input.c revision 1.37
      1  1.37     perry /*	$NetBSD: ip_input.c,v 1.37 1996/09/21 19:44:33 perry Exp $	*/
      2  1.14       cgd 
      3   1.1       cgd /*
      4  1.13   mycroft  * Copyright (c) 1982, 1986, 1988, 1993
      5  1.13   mycroft  *	The Regents of the University of California.  All rights reserved.
      6   1.1       cgd  *
      7   1.1       cgd  * Redistribution and use in source and binary forms, with or without
      8   1.1       cgd  * modification, are permitted provided that the following conditions
      9   1.1       cgd  * are met:
     10   1.1       cgd  * 1. Redistributions of source code must retain the above copyright
     11   1.1       cgd  *    notice, this list of conditions and the following disclaimer.
     12   1.1       cgd  * 2. Redistributions in binary form must reproduce the above copyright
     13   1.1       cgd  *    notice, this list of conditions and the following disclaimer in the
     14   1.1       cgd  *    documentation and/or other materials provided with the distribution.
     15   1.1       cgd  * 3. All advertising materials mentioning features or use of this software
     16   1.1       cgd  *    must display the following acknowledgement:
     17   1.1       cgd  *	This product includes software developed by the University of
     18   1.1       cgd  *	California, Berkeley and its contributors.
     19   1.1       cgd  * 4. Neither the name of the University nor the names of its contributors
     20   1.1       cgd  *    may be used to endorse or promote products derived from this software
     21   1.1       cgd  *    without specific prior written permission.
     22   1.1       cgd  *
     23   1.1       cgd  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     24   1.1       cgd  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     25   1.1       cgd  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     26   1.1       cgd  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     27   1.1       cgd  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     28   1.1       cgd  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     29   1.1       cgd  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     30   1.1       cgd  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     31   1.1       cgd  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     32   1.1       cgd  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     33   1.1       cgd  * SUCH DAMAGE.
     34   1.1       cgd  *
     35  1.14       cgd  *	@(#)ip_input.c	8.2 (Berkeley) 1/4/94
     36   1.1       cgd  */
     37   1.1       cgd 
     38   1.5   mycroft #include <sys/param.h>
     39   1.5   mycroft #include <sys/systm.h>
     40   1.5   mycroft #include <sys/malloc.h>
     41   1.5   mycroft #include <sys/mbuf.h>
     42   1.5   mycroft #include <sys/domain.h>
     43   1.5   mycroft #include <sys/protosw.h>
     44   1.5   mycroft #include <sys/socket.h>
     45   1.5   mycroft #include <sys/errno.h>
     46   1.5   mycroft #include <sys/time.h>
     47   1.5   mycroft #include <sys/kernel.h>
     48  1.28  christos #include <sys/proc.h>
     49  1.28  christos 
     50  1.28  christos #include <vm/vm.h>
     51  1.28  christos #include <sys/sysctl.h>
     52   1.1       cgd 
     53   1.5   mycroft #include <net/if.h>
     54   1.5   mycroft #include <net/route.h>
     55   1.1       cgd 
     56   1.5   mycroft #include <netinet/in.h>
     57   1.5   mycroft #include <netinet/in_systm.h>
     58   1.5   mycroft #include <netinet/ip.h>
     59   1.5   mycroft #include <netinet/in_pcb.h>
     60   1.5   mycroft #include <netinet/in_var.h>
     61   1.5   mycroft #include <netinet/ip_var.h>
     62   1.5   mycroft #include <netinet/ip_icmp.h>
     63   1.1       cgd 
     64  1.36       mrg #ifdef PFIL_HOOKS
     65  1.36       mrg #include <net/pfil.h>
     66  1.36       mrg #endif /* PFIL_HOOKS */
     67  1.36       mrg 
     68   1.1       cgd #ifndef	IPFORWARDING
     69   1.1       cgd #ifdef GATEWAY
     70   1.1       cgd #define	IPFORWARDING	1	/* forward IP packets not for us */
     71   1.1       cgd #else /* GATEWAY */
     72   1.1       cgd #define	IPFORWARDING	0	/* don't forward IP packets not for us */
     73   1.1       cgd #endif /* GATEWAY */
     74   1.1       cgd #endif /* IPFORWARDING */
     75   1.1       cgd #ifndef	IPSENDREDIRECTS
     76   1.1       cgd #define	IPSENDREDIRECTS	1
     77   1.1       cgd #endif
     78  1.26   thorpej #ifndef IPFORWSRCRT
     79  1.26   thorpej #define	IPFORWSRCRT	1	/* allow source-routed packets */
     80  1.26   thorpej #endif
     81  1.27   thorpej /*
     82  1.27   thorpej  * Note: DIRECTED_BROADCAST is handled this way so that previous
     83  1.27   thorpej  * configuration using this option will Just Work.
     84  1.27   thorpej  */
     85  1.27   thorpej #ifndef IPDIRECTEDBCAST
     86  1.27   thorpej #ifdef DIRECTED_BROADCAST
     87  1.27   thorpej #define IPDIRECTEDBCAST	1
     88  1.27   thorpej #else
     89  1.27   thorpej #define	IPDIRECTEDBCAST	0
     90  1.27   thorpej #endif /* DIRECTED_BROADCAST */
     91  1.27   thorpej #endif /* IPDIRECTEDBCAST */
     92   1.1       cgd int	ipforwarding = IPFORWARDING;
     93   1.1       cgd int	ipsendredirects = IPSENDREDIRECTS;
     94  1.13   mycroft int	ip_defttl = IPDEFTTL;
     95  1.26   thorpej int	ip_forwsrcrt = IPFORWSRCRT;
     96  1.27   thorpej int	ip_directedbcast = IPDIRECTEDBCAST;
     97   1.1       cgd #ifdef DIAGNOSTIC
     98   1.1       cgd int	ipprintfs = 0;
     99   1.1       cgd #endif
    100   1.1       cgd 
    101   1.1       cgd extern	struct domain inetdomain;
    102   1.1       cgd extern	struct protosw inetsw[];
    103   1.1       cgd u_char	ip_protox[IPPROTO_MAX];
    104   1.1       cgd int	ipqmaxlen = IFQ_MAXLEN;
    105  1.22   mycroft struct	in_ifaddrhead in_ifaddr;
    106  1.13   mycroft struct	ifqueue ipintrq;
    107   1.1       cgd 
    108   1.1       cgd /*
    109   1.1       cgd  * We need to save the IP options in case a protocol wants to respond
    110   1.1       cgd  * to an incoming packet over the same route if the packet got here
    111   1.1       cgd  * using IP source routing.  This allows connection establishment and
    112   1.1       cgd  * maintenance when the remote end is on a network that is not known
    113   1.1       cgd  * to us.
    114   1.1       cgd  */
    115   1.1       cgd int	ip_nhops = 0;
    116   1.1       cgd static	struct ip_srcrt {
    117   1.1       cgd 	struct	in_addr dst;			/* final destination */
    118   1.1       cgd 	char	nop;				/* one NOP to align */
    119   1.1       cgd 	char	srcopt[IPOPT_OFFSET + 1];	/* OPTVAL, OLEN and OFFSET */
    120   1.1       cgd 	struct	in_addr route[MAX_IPOPTLEN/sizeof(struct in_addr)];
    121   1.1       cgd } ip_srcrt;
    122   1.1       cgd 
    123  1.13   mycroft static void save_rte __P((u_char *, struct in_addr));
    124  1.35   mycroft 
    125   1.1       cgd /*
    126   1.1       cgd  * IP initialization: fill in IP protocol switch table.
    127   1.1       cgd  * All protocols not implemented in kernel go to raw IP protocol handler.
    128   1.1       cgd  */
    129   1.8   mycroft void
    130   1.1       cgd ip_init()
    131   1.1       cgd {
    132   1.1       cgd 	register struct protosw *pr;
    133   1.1       cgd 	register int i;
    134   1.1       cgd 
    135   1.1       cgd 	pr = pffindproto(PF_INET, IPPROTO_RAW, SOCK_RAW);
    136   1.1       cgd 	if (pr == 0)
    137   1.1       cgd 		panic("ip_init");
    138   1.1       cgd 	for (i = 0; i < IPPROTO_MAX; i++)
    139   1.1       cgd 		ip_protox[i] = pr - inetsw;
    140   1.1       cgd 	for (pr = inetdomain.dom_protosw;
    141   1.1       cgd 	    pr < inetdomain.dom_protoswNPROTOSW; pr++)
    142   1.1       cgd 		if (pr->pr_domain->dom_family == PF_INET &&
    143   1.1       cgd 		    pr->pr_protocol && pr->pr_protocol != IPPROTO_RAW)
    144   1.1       cgd 			ip_protox[pr->pr_protocol] = pr - inetsw;
    145  1.25       cgd 	LIST_INIT(&ipq);
    146   1.1       cgd 	ip_id = time.tv_sec & 0xffff;
    147   1.1       cgd 	ipintrq.ifq_maxlen = ipqmaxlen;
    148  1.22   mycroft 	TAILQ_INIT(&in_ifaddr);
    149   1.1       cgd }
    150   1.1       cgd 
    151   1.1       cgd struct	sockaddr_in ipaddr = { sizeof(ipaddr), AF_INET };
    152   1.1       cgd struct	route ipforward_rt;
    153   1.1       cgd 
    154   1.1       cgd /*
    155   1.1       cgd  * Ip input routine.  Checksum and byte swap header.  If fragmented
    156   1.1       cgd  * try to reassemble.  Process options.  Pass to next level.
    157   1.1       cgd  */
    158   1.8   mycroft void
    159   1.1       cgd ipintr()
    160   1.1       cgd {
    161  1.33       mrg 	register struct ip *ip = NULL;
    162   1.1       cgd 	register struct mbuf *m;
    163   1.1       cgd 	register struct ipq *fp;
    164   1.1       cgd 	register struct in_ifaddr *ia;
    165  1.25       cgd 	struct ipqent *ipqe;
    166  1.35   mycroft 	int hlen = 0, mff, len, s;
    167  1.36       mrg #ifdef PFIL_HOOKS
    168  1.33       mrg 	struct packet_filter_hook *pfh;
    169  1.33       mrg 	struct mbuf *m0;
    170  1.36       mrg #endif /* PFIL_HOOKS */
    171   1.1       cgd 
    172   1.1       cgd next:
    173   1.1       cgd 	/*
    174   1.1       cgd 	 * Get next datagram off input queue and get IP header
    175   1.1       cgd 	 * in first mbuf.
    176   1.1       cgd 	 */
    177   1.1       cgd 	s = splimp();
    178   1.1       cgd 	IF_DEQUEUE(&ipintrq, m);
    179   1.1       cgd 	splx(s);
    180  1.13   mycroft 	if (m == 0)
    181   1.1       cgd 		return;
    182   1.1       cgd #ifdef	DIAGNOSTIC
    183   1.1       cgd 	if ((m->m_flags & M_PKTHDR) == 0)
    184   1.1       cgd 		panic("ipintr no HDR");
    185   1.1       cgd #endif
    186   1.1       cgd 	/*
    187   1.1       cgd 	 * If no IP addresses have been set yet but the interfaces
    188   1.1       cgd 	 * are receiving, can't do anything with incoming packets yet.
    189   1.1       cgd 	 */
    190  1.22   mycroft 	if (in_ifaddr.tqh_first == 0)
    191   1.1       cgd 		goto bad;
    192   1.1       cgd 	ipstat.ips_total++;
    193   1.1       cgd 	if (m->m_len < sizeof (struct ip) &&
    194   1.1       cgd 	    (m = m_pullup(m, sizeof (struct ip))) == 0) {
    195   1.1       cgd 		ipstat.ips_toosmall++;
    196   1.1       cgd 		goto next;
    197   1.1       cgd 	}
    198   1.1       cgd 	ip = mtod(m, struct ip *);
    199  1.13   mycroft 	if (ip->ip_v != IPVERSION) {
    200  1.13   mycroft 		ipstat.ips_badvers++;
    201  1.13   mycroft 		goto bad;
    202  1.13   mycroft 	}
    203   1.1       cgd 	hlen = ip->ip_hl << 2;
    204   1.1       cgd 	if (hlen < sizeof(struct ip)) {	/* minimum header length */
    205   1.1       cgd 		ipstat.ips_badhlen++;
    206   1.1       cgd 		goto bad;
    207   1.1       cgd 	}
    208   1.1       cgd 	if (hlen > m->m_len) {
    209   1.1       cgd 		if ((m = m_pullup(m, hlen)) == 0) {
    210   1.1       cgd 			ipstat.ips_badhlen++;
    211   1.1       cgd 			goto next;
    212   1.1       cgd 		}
    213   1.1       cgd 		ip = mtod(m, struct ip *);
    214   1.1       cgd 	}
    215  1.28  christos 	if ((ip->ip_sum = in_cksum(m, hlen)) != 0) {
    216   1.1       cgd 		ipstat.ips_badsum++;
    217   1.1       cgd 		goto bad;
    218   1.1       cgd 	}
    219   1.1       cgd 
    220   1.1       cgd 	/*
    221   1.1       cgd 	 * Convert fields to host representation.
    222   1.1       cgd 	 */
    223   1.1       cgd 	NTOHS(ip->ip_len);
    224   1.1       cgd 	NTOHS(ip->ip_id);
    225   1.1       cgd 	NTOHS(ip->ip_off);
    226  1.35   mycroft 	len = ip->ip_len;
    227   1.1       cgd 
    228   1.1       cgd 	/*
    229   1.1       cgd 	 * Check that the amount of data in the buffers
    230   1.1       cgd 	 * is as at least much as the IP header would have us expect.
    231   1.1       cgd 	 * Trim mbufs if longer than we expect.
    232   1.1       cgd 	 * Drop packet if shorter than we expect.
    233   1.1       cgd 	 */
    234  1.35   mycroft 	if (m->m_pkthdr.len < len) {
    235   1.1       cgd 		ipstat.ips_tooshort++;
    236   1.1       cgd 		goto bad;
    237   1.1       cgd 	}
    238  1.35   mycroft 	if (m->m_pkthdr.len > len) {
    239   1.1       cgd 		if (m->m_len == m->m_pkthdr.len) {
    240  1.35   mycroft 			m->m_len = len;
    241  1.35   mycroft 			m->m_pkthdr.len = len;
    242   1.1       cgd 		} else
    243  1.35   mycroft 			m_adj(m, len - m->m_pkthdr.len);
    244   1.1       cgd 	}
    245   1.1       cgd 
    246  1.36       mrg #ifdef PFIL_HOOKS
    247  1.33       mrg 	/*
    248  1.33       mrg 	 * Run through list of hooks for input packets.
    249  1.33       mrg 	 */
    250  1.33       mrg 	m0 = m;
    251  1.33       mrg 	for (pfh = pfil_hook_get(PFIL_IN); pfh; pfh = pfh->pfil_link.le_next)
    252  1.33       mrg 		if (pfh->pfil_func) {
    253  1.33       mrg 			if (pfh->pfil_func(ip, hlen, m->m_pkthdr.rcvif, 0, &m0))
    254  1.33       mrg 				goto bad;
    255  1.33       mrg 			ip = mtod(m = m0, struct ip *);
    256  1.33       mrg 		}
    257  1.36       mrg #endif /* PFIL_HOOKS */
    258  1.33       mrg 
    259   1.1       cgd 	/*
    260   1.1       cgd 	 * Process options and, if not destined for us,
    261   1.1       cgd 	 * ship it on.  ip_dooptions returns 1 when an
    262   1.1       cgd 	 * error was detected (causing an icmp message
    263   1.1       cgd 	 * to be sent and the original packet to be freed).
    264   1.1       cgd 	 */
    265   1.1       cgd 	ip_nhops = 0;		/* for source routed packets */
    266   1.1       cgd 	if (hlen > sizeof (struct ip) && ip_dooptions(m))
    267   1.1       cgd 		goto next;
    268   1.1       cgd 
    269   1.1       cgd 	/*
    270   1.1       cgd 	 * Check our list of addresses, to see if the packet is for us.
    271   1.1       cgd 	 */
    272  1.22   mycroft 	for (ia = in_ifaddr.tqh_first; ia; ia = ia->ia_list.tqe_next) {
    273  1.35   mycroft 		if (in_hosteq(ip->ip_dst, ia->ia_addr.sin_addr))
    274   1.1       cgd 			goto ours;
    275  1.27   thorpej 		if (((ip_directedbcast == 0) || (ip_directedbcast &&
    276  1.27   thorpej 		    ia->ia_ifp == m->m_pkthdr.rcvif)) &&
    277   1.1       cgd 		    (ia->ia_ifp->if_flags & IFF_BROADCAST)) {
    278  1.35   mycroft 			if (in_hosteq(ip->ip_dst, ia->ia_broadaddr.sin_addr) ||
    279  1.35   mycroft 			    in_hosteq(ip->ip_dst, ia->ia_netbroadcast) ||
    280  1.20   mycroft 			    /*
    281  1.20   mycroft 			     * Look for all-0's host part (old broadcast addr),
    282  1.20   mycroft 			     * either for subnet or net.
    283  1.20   mycroft 			     */
    284  1.20   mycroft 			    ip->ip_dst.s_addr == ia->ia_subnet ||
    285  1.18   mycroft 			    ip->ip_dst.s_addr == ia->ia_net)
    286   1.1       cgd 				goto ours;
    287   1.1       cgd 		}
    288   1.1       cgd 	}
    289  1.18   mycroft 	if (IN_MULTICAST(ip->ip_dst.s_addr)) {
    290   1.4   hpeyerl 		struct in_multi *inm;
    291   1.4   hpeyerl #ifdef MROUTING
    292   1.4   hpeyerl 		extern struct socket *ip_mrouter;
    293  1.10    brezak 
    294  1.10    brezak 		if (m->m_flags & M_EXT) {
    295  1.10    brezak 			if ((m = m_pullup(m, hlen)) == 0) {
    296  1.10    brezak 				ipstat.ips_toosmall++;
    297  1.10    brezak 				goto next;
    298  1.10    brezak 			}
    299  1.10    brezak 			ip = mtod(m, struct ip *);
    300  1.10    brezak 		}
    301   1.4   hpeyerl 
    302   1.4   hpeyerl 		if (ip_mrouter) {
    303   1.4   hpeyerl 			/*
    304   1.4   hpeyerl 			 * If we are acting as a multicast router, all
    305   1.4   hpeyerl 			 * incoming multicast packets are passed to the
    306   1.4   hpeyerl 			 * kernel-level multicast forwarding function.
    307   1.4   hpeyerl 			 * The packet is returned (relatively) intact; if
    308   1.4   hpeyerl 			 * ip_mforward() returns a non-zero value, the packet
    309   1.4   hpeyerl 			 * must be discarded, else it may be accepted below.
    310   1.4   hpeyerl 			 *
    311   1.4   hpeyerl 			 * (The IP ident field is put in the same byte order
    312   1.4   hpeyerl 			 * as expected when ip_mforward() is called from
    313   1.4   hpeyerl 			 * ip_output().)
    314   1.4   hpeyerl 			 */
    315   1.4   hpeyerl 			ip->ip_id = htons(ip->ip_id);
    316  1.13   mycroft 			if (ip_mforward(m, m->m_pkthdr.rcvif) != 0) {
    317  1.13   mycroft 				ipstat.ips_cantforward++;
    318   1.4   hpeyerl 				m_freem(m);
    319   1.4   hpeyerl 				goto next;
    320   1.4   hpeyerl 			}
    321   1.4   hpeyerl 			ip->ip_id = ntohs(ip->ip_id);
    322   1.4   hpeyerl 
    323   1.4   hpeyerl 			/*
    324   1.4   hpeyerl 			 * The process-level routing demon needs to receive
    325   1.4   hpeyerl 			 * all multicast IGMP packets, whether or not this
    326   1.4   hpeyerl 			 * host belongs to their destination groups.
    327   1.4   hpeyerl 			 */
    328   1.4   hpeyerl 			if (ip->ip_p == IPPROTO_IGMP)
    329   1.4   hpeyerl 				goto ours;
    330  1.13   mycroft 			ipstat.ips_forward++;
    331   1.4   hpeyerl 		}
    332   1.4   hpeyerl #endif
    333   1.4   hpeyerl 		/*
    334   1.4   hpeyerl 		 * See if we belong to the destination multicast group on the
    335   1.4   hpeyerl 		 * arrival interface.
    336   1.4   hpeyerl 		 */
    337   1.4   hpeyerl 		IN_LOOKUP_MULTI(ip->ip_dst, m->m_pkthdr.rcvif, inm);
    338   1.4   hpeyerl 		if (inm == NULL) {
    339  1.13   mycroft 			ipstat.ips_cantforward++;
    340   1.4   hpeyerl 			m_freem(m);
    341   1.4   hpeyerl 			goto next;
    342   1.4   hpeyerl 		}
    343   1.4   hpeyerl 		goto ours;
    344   1.4   hpeyerl 	}
    345  1.19   mycroft 	if (ip->ip_dst.s_addr == INADDR_BROADCAST ||
    346  1.35   mycroft 	    in_nullhost(ip->ip_dst))
    347   1.1       cgd 		goto ours;
    348   1.1       cgd 
    349   1.1       cgd 	/*
    350   1.1       cgd 	 * Not for us; forward if possible and desirable.
    351   1.1       cgd 	 */
    352   1.1       cgd 	if (ipforwarding == 0) {
    353   1.1       cgd 		ipstat.ips_cantforward++;
    354   1.1       cgd 		m_freem(m);
    355   1.1       cgd 	} else
    356   1.1       cgd 		ip_forward(m, 0);
    357   1.1       cgd 	goto next;
    358   1.1       cgd 
    359   1.1       cgd ours:
    360   1.1       cgd 	/*
    361   1.1       cgd 	 * If offset or IP_MF are set, must reassemble.
    362   1.1       cgd 	 * Otherwise, nothing need be done.
    363   1.1       cgd 	 * (We could look in the reassembly queue to see
    364   1.1       cgd 	 * if the packet was previously fragmented,
    365   1.1       cgd 	 * but it's not worth the time; just let them time out.)
    366   1.1       cgd 	 */
    367  1.37     perry 	if (ip->ip_off & ~(IP_DF|IP_RF)) {
    368   1.1       cgd 		if (m->m_flags & M_EXT) {		/* XXX */
    369   1.1       cgd 			if ((m = m_pullup(m, sizeof (struct ip))) == 0) {
    370   1.1       cgd 				ipstat.ips_toosmall++;
    371   1.1       cgd 				goto next;
    372   1.1       cgd 			}
    373   1.1       cgd 			ip = mtod(m, struct ip *);
    374   1.1       cgd 		}
    375   1.1       cgd 		/*
    376   1.1       cgd 		 * Look for queue of fragments
    377   1.1       cgd 		 * of this datagram.
    378   1.1       cgd 		 */
    379  1.25       cgd 		for (fp = ipq.lh_first; fp != NULL; fp = fp->ipq_q.le_next)
    380   1.1       cgd 			if (ip->ip_id == fp->ipq_id &&
    381  1.35   mycroft 			    in_hosteq(ip->ip_src, fp->ipq_src) &&
    382  1.35   mycroft 			    in_hosteq(ip->ip_dst, fp->ipq_dst) &&
    383   1.1       cgd 			    ip->ip_p == fp->ipq_p)
    384   1.1       cgd 				goto found;
    385   1.1       cgd 		fp = 0;
    386   1.1       cgd found:
    387   1.1       cgd 
    388   1.1       cgd 		/*
    389   1.1       cgd 		 * Adjust ip_len to not reflect header,
    390  1.25       cgd 		 * set ipqe_mff if more fragments are expected,
    391   1.1       cgd 		 * convert offset of this to bytes.
    392   1.1       cgd 		 */
    393   1.1       cgd 		ip->ip_len -= hlen;
    394  1.25       cgd 		mff = (ip->ip_off & IP_MF) != 0;
    395  1.25       cgd 		if (mff) {
    396  1.16       cgd 		        /*
    397  1.16       cgd 		         * Make sure that fragments have a data length
    398  1.16       cgd 			 * that's a non-zero multiple of 8 bytes.
    399  1.16       cgd 		         */
    400  1.17       cgd 			if (ip->ip_len == 0 || (ip->ip_len & 0x7) != 0) {
    401  1.16       cgd 				ipstat.ips_badfrags++;
    402  1.16       cgd 				goto bad;
    403  1.16       cgd 			}
    404  1.16       cgd 		}
    405   1.1       cgd 		ip->ip_off <<= 3;
    406   1.1       cgd 
    407   1.1       cgd 		/*
    408   1.1       cgd 		 * If datagram marked as having more fragments
    409   1.1       cgd 		 * or if this is not the first fragment,
    410   1.1       cgd 		 * attempt reassembly; if it succeeds, proceed.
    411   1.1       cgd 		 */
    412  1.25       cgd 		if (mff || ip->ip_off) {
    413   1.1       cgd 			ipstat.ips_fragments++;
    414  1.25       cgd 			MALLOC(ipqe, struct ipqent *, sizeof (struct ipqent),
    415  1.25       cgd 			    M_IPQ, M_NOWAIT);
    416  1.25       cgd 			if (ipqe == NULL) {
    417  1.25       cgd 				ipstat.ips_rcvmemdrop++;
    418  1.25       cgd 				goto bad;
    419  1.25       cgd 			}
    420  1.25       cgd 			ipqe->ipqe_mff = mff;
    421  1.25       cgd 			ipqe->ipqe_ip = ip;
    422  1.25       cgd 			ip = ip_reass(ipqe, fp);
    423   1.1       cgd 			if (ip == 0)
    424   1.1       cgd 				goto next;
    425  1.13   mycroft 			ipstat.ips_reassembled++;
    426   1.1       cgd 			m = dtom(ip);
    427   1.1       cgd 		} else
    428   1.1       cgd 			if (fp)
    429   1.1       cgd 				ip_freef(fp);
    430   1.1       cgd 	} else
    431   1.1       cgd 		ip->ip_len -= hlen;
    432   1.1       cgd 
    433   1.1       cgd 	/*
    434   1.1       cgd 	 * Switch out to protocol's input routine.
    435   1.1       cgd 	 */
    436   1.1       cgd 	ipstat.ips_delivered++;
    437   1.1       cgd 	(*inetsw[ip_protox[ip->ip_p]].pr_input)(m, hlen);
    438   1.1       cgd 	goto next;
    439   1.1       cgd bad:
    440  1.36       mrg #ifdef PFIL_HOOKS
    441  1.33       mrg 	m0 = m;
    442  1.33       mrg 	for (pfh = pfil_hook_get(PFIL_BAD); pfh; pfh = pfh->pfil_link.le_next)
    443  1.33       mrg 		if (pfh->pfil_func) {
    444  1.33       mrg 			(void)pfh->pfil_func(ip, hlen, m->m_pkthdr.rcvif, 2, &m0);
    445  1.33       mrg 			ip = mtod(m = m0, struct ip *);
    446  1.33       mrg 		}
    447  1.36       mrg #endif /* PFIL_HOOKS */
    448   1.1       cgd 	m_freem(m);
    449   1.1       cgd 	goto next;
    450   1.1       cgd }
    451   1.1       cgd 
    452   1.1       cgd /*
    453   1.1       cgd  * Take incoming datagram fragment and try to
    454   1.1       cgd  * reassemble it into whole datagram.  If a chain for
    455   1.1       cgd  * reassembly of this datagram already exists, then it
    456   1.1       cgd  * is given as fp; otherwise have to make a chain.
    457   1.1       cgd  */
    458   1.1       cgd struct ip *
    459  1.25       cgd ip_reass(ipqe, fp)
    460  1.25       cgd 	register struct ipqent *ipqe;
    461   1.1       cgd 	register struct ipq *fp;
    462   1.1       cgd {
    463  1.25       cgd 	register struct mbuf *m = dtom(ipqe->ipqe_ip);
    464  1.25       cgd 	register struct ipqent *nq, *p, *q;
    465  1.25       cgd 	struct ip *ip;
    466   1.1       cgd 	struct mbuf *t;
    467  1.25       cgd 	int hlen = ipqe->ipqe_ip->ip_hl << 2;
    468   1.1       cgd 	int i, next;
    469   1.1       cgd 
    470   1.1       cgd 	/*
    471   1.1       cgd 	 * Presence of header sizes in mbufs
    472   1.1       cgd 	 * would confuse code below.
    473   1.1       cgd 	 */
    474   1.1       cgd 	m->m_data += hlen;
    475   1.1       cgd 	m->m_len -= hlen;
    476   1.1       cgd 
    477   1.1       cgd 	/*
    478   1.1       cgd 	 * If first fragment to arrive, create a reassembly queue.
    479   1.1       cgd 	 */
    480   1.1       cgd 	if (fp == 0) {
    481   1.1       cgd 		if ((t = m_get(M_DONTWAIT, MT_FTABLE)) == NULL)
    482   1.1       cgd 			goto dropfrag;
    483   1.1       cgd 		fp = mtod(t, struct ipq *);
    484  1.25       cgd 		LIST_INSERT_HEAD(&ipq, fp, ipq_q);
    485   1.1       cgd 		fp->ipq_ttl = IPFRAGTTL;
    486  1.25       cgd 		fp->ipq_p = ipqe->ipqe_ip->ip_p;
    487  1.25       cgd 		fp->ipq_id = ipqe->ipqe_ip->ip_id;
    488  1.25       cgd 		LIST_INIT(&fp->ipq_fragq);
    489  1.25       cgd 		fp->ipq_src = ipqe->ipqe_ip->ip_src;
    490  1.25       cgd 		fp->ipq_dst = ipqe->ipqe_ip->ip_dst;
    491  1.25       cgd 		p = NULL;
    492   1.1       cgd 		goto insert;
    493   1.1       cgd 	}
    494   1.1       cgd 
    495   1.1       cgd 	/*
    496   1.1       cgd 	 * Find a segment which begins after this one does.
    497   1.1       cgd 	 */
    498  1.25       cgd 	for (p = NULL, q = fp->ipq_fragq.lh_first; q != NULL;
    499  1.25       cgd 	    p = q, q = q->ipqe_q.le_next)
    500  1.25       cgd 		if (q->ipqe_ip->ip_off > ipqe->ipqe_ip->ip_off)
    501   1.1       cgd 			break;
    502   1.1       cgd 
    503   1.1       cgd 	/*
    504   1.1       cgd 	 * If there is a preceding segment, it may provide some of
    505   1.1       cgd 	 * our data already.  If so, drop the data from the incoming
    506   1.1       cgd 	 * segment.  If it provides all of our data, drop us.
    507   1.1       cgd 	 */
    508  1.25       cgd 	if (p != NULL) {
    509  1.25       cgd 		i = p->ipqe_ip->ip_off + p->ipqe_ip->ip_len -
    510  1.25       cgd 		    ipqe->ipqe_ip->ip_off;
    511   1.1       cgd 		if (i > 0) {
    512  1.25       cgd 			if (i >= ipqe->ipqe_ip->ip_len)
    513   1.1       cgd 				goto dropfrag;
    514  1.25       cgd 			m_adj(dtom(ipqe->ipqe_ip), i);
    515  1.25       cgd 			ipqe->ipqe_ip->ip_off += i;
    516  1.25       cgd 			ipqe->ipqe_ip->ip_len -= i;
    517   1.1       cgd 		}
    518   1.1       cgd 	}
    519   1.1       cgd 
    520   1.1       cgd 	/*
    521   1.1       cgd 	 * While we overlap succeeding segments trim them or,
    522   1.1       cgd 	 * if they are completely covered, dequeue them.
    523   1.1       cgd 	 */
    524  1.25       cgd 	for (; q != NULL && ipqe->ipqe_ip->ip_off + ipqe->ipqe_ip->ip_len >
    525  1.25       cgd 	    q->ipqe_ip->ip_off; q = nq) {
    526  1.25       cgd 		i = (ipqe->ipqe_ip->ip_off + ipqe->ipqe_ip->ip_len) -
    527  1.25       cgd 		    q->ipqe_ip->ip_off;
    528  1.25       cgd 		if (i < q->ipqe_ip->ip_len) {
    529  1.25       cgd 			q->ipqe_ip->ip_len -= i;
    530  1.25       cgd 			q->ipqe_ip->ip_off += i;
    531  1.25       cgd 			m_adj(dtom(q->ipqe_ip), i);
    532   1.1       cgd 			break;
    533   1.1       cgd 		}
    534  1.25       cgd 		nq = q->ipqe_q.le_next;
    535  1.25       cgd 		m_freem(dtom(q->ipqe_ip));
    536  1.25       cgd 		LIST_REMOVE(q, ipqe_q);
    537  1.25       cgd 		FREE(q, M_IPQ);
    538   1.1       cgd 	}
    539   1.1       cgd 
    540   1.1       cgd insert:
    541   1.1       cgd 	/*
    542   1.1       cgd 	 * Stick new segment in its place;
    543   1.1       cgd 	 * check for complete reassembly.
    544   1.1       cgd 	 */
    545  1.25       cgd 	if (p == NULL) {
    546  1.25       cgd 		LIST_INSERT_HEAD(&fp->ipq_fragq, ipqe, ipqe_q);
    547  1.25       cgd 	} else {
    548  1.25       cgd 		LIST_INSERT_AFTER(p, ipqe, ipqe_q);
    549  1.25       cgd 	}
    550   1.1       cgd 	next = 0;
    551  1.25       cgd 	for (p = NULL, q = fp->ipq_fragq.lh_first; q != NULL;
    552  1.25       cgd 	    p = q, q = q->ipqe_q.le_next) {
    553  1.25       cgd 		if (q->ipqe_ip->ip_off != next)
    554   1.1       cgd 			return (0);
    555  1.25       cgd 		next += q->ipqe_ip->ip_len;
    556   1.1       cgd 	}
    557  1.25       cgd 	if (p->ipqe_mff)
    558   1.1       cgd 		return (0);
    559   1.1       cgd 
    560   1.1       cgd 	/*
    561   1.1       cgd 	 * Reassembly is complete; concatenate fragments.
    562   1.1       cgd 	 */
    563  1.25       cgd 	q = fp->ipq_fragq.lh_first;
    564  1.25       cgd 	ip = q->ipqe_ip;
    565  1.25       cgd 	m = dtom(q->ipqe_ip);
    566   1.1       cgd 	t = m->m_next;
    567   1.1       cgd 	m->m_next = 0;
    568   1.1       cgd 	m_cat(m, t);
    569  1.25       cgd 	nq = q->ipqe_q.le_next;
    570  1.25       cgd 	FREE(q, M_IPQ);
    571  1.25       cgd 	for (q = nq; q != NULL; q = nq) {
    572  1.25       cgd 		t = dtom(q->ipqe_ip);
    573  1.25       cgd 		nq = q->ipqe_q.le_next;
    574  1.25       cgd 		FREE(q, M_IPQ);
    575   1.1       cgd 		m_cat(m, t);
    576   1.1       cgd 	}
    577   1.1       cgd 
    578   1.1       cgd 	/*
    579   1.1       cgd 	 * Create header for new ip packet by
    580   1.1       cgd 	 * modifying header of first packet;
    581   1.1       cgd 	 * dequeue and discard fragment reassembly header.
    582   1.1       cgd 	 * Make header visible.
    583   1.1       cgd 	 */
    584   1.1       cgd 	ip->ip_len = next;
    585  1.25       cgd 	ip->ip_src = fp->ipq_src;
    586  1.25       cgd 	ip->ip_dst = fp->ipq_dst;
    587  1.25       cgd 	LIST_REMOVE(fp, ipq_q);
    588   1.1       cgd 	(void) m_free(dtom(fp));
    589   1.1       cgd 	m->m_len += (ip->ip_hl << 2);
    590   1.1       cgd 	m->m_data -= (ip->ip_hl << 2);
    591   1.1       cgd 	/* some debugging cruft by sklower, below, will go away soon */
    592   1.1       cgd 	if (m->m_flags & M_PKTHDR) { /* XXX this should be done elsewhere */
    593   1.1       cgd 		register int plen = 0;
    594   1.1       cgd 		for (t = m; m; m = m->m_next)
    595   1.1       cgd 			plen += m->m_len;
    596   1.1       cgd 		t->m_pkthdr.len = plen;
    597   1.1       cgd 	}
    598  1.25       cgd 	return (ip);
    599   1.1       cgd 
    600   1.1       cgd dropfrag:
    601   1.1       cgd 	ipstat.ips_fragdropped++;
    602   1.1       cgd 	m_freem(m);
    603  1.25       cgd 	FREE(ipqe, M_IPQ);
    604   1.1       cgd 	return (0);
    605   1.1       cgd }
    606   1.1       cgd 
    607   1.1       cgd /*
    608   1.1       cgd  * Free a fragment reassembly header and all
    609   1.1       cgd  * associated datagrams.
    610   1.1       cgd  */
    611   1.8   mycroft void
    612   1.1       cgd ip_freef(fp)
    613   1.1       cgd 	struct ipq *fp;
    614   1.1       cgd {
    615  1.25       cgd 	register struct ipqent *q, *p;
    616   1.1       cgd 
    617  1.25       cgd 	for (q = fp->ipq_fragq.lh_first; q != NULL; q = p) {
    618  1.25       cgd 		p = q->ipqe_q.le_next;
    619  1.25       cgd 		m_freem(dtom(q->ipqe_ip));
    620  1.25       cgd 		LIST_REMOVE(q, ipqe_q);
    621  1.25       cgd 		FREE(q, M_IPQ);
    622   1.1       cgd 	}
    623  1.25       cgd 	LIST_REMOVE(fp, ipq_q);
    624   1.1       cgd 	(void) m_free(dtom(fp));
    625   1.1       cgd }
    626   1.1       cgd 
    627   1.1       cgd /*
    628   1.1       cgd  * IP timer processing;
    629   1.1       cgd  * if a timer expires on a reassembly
    630   1.1       cgd  * queue, discard it.
    631   1.1       cgd  */
    632   1.8   mycroft void
    633   1.1       cgd ip_slowtimo()
    634   1.1       cgd {
    635  1.25       cgd 	register struct ipq *fp, *nfp;
    636  1.24   mycroft 	int s = splsoftnet();
    637   1.1       cgd 
    638  1.25       cgd 	for (fp = ipq.lh_first; fp != NULL; fp = nfp) {
    639  1.25       cgd 		nfp = fp->ipq_q.le_next;
    640  1.25       cgd 		if (--fp->ipq_ttl == 0) {
    641   1.1       cgd 			ipstat.ips_fragtimeout++;
    642  1.25       cgd 			ip_freef(fp);
    643   1.1       cgd 		}
    644   1.1       cgd 	}
    645   1.1       cgd 	splx(s);
    646   1.1       cgd }
    647   1.1       cgd 
    648   1.1       cgd /*
    649   1.1       cgd  * Drain off all datagram fragments.
    650   1.1       cgd  */
    651   1.8   mycroft void
    652   1.1       cgd ip_drain()
    653   1.1       cgd {
    654   1.1       cgd 
    655  1.25       cgd 	while (ipq.lh_first != NULL) {
    656   1.1       cgd 		ipstat.ips_fragdropped++;
    657  1.25       cgd 		ip_freef(ipq.lh_first);
    658   1.1       cgd 	}
    659   1.1       cgd }
    660   1.1       cgd 
    661   1.1       cgd /*
    662   1.1       cgd  * Do option processing on a datagram,
    663   1.1       cgd  * possibly discarding it if bad options are encountered,
    664   1.1       cgd  * or forwarding it if source-routed.
    665   1.1       cgd  * Returns 1 if packet has been forwarded/freed,
    666   1.1       cgd  * 0 if the packet should be processed further.
    667   1.1       cgd  */
    668   1.8   mycroft int
    669   1.1       cgd ip_dooptions(m)
    670   1.1       cgd 	struct mbuf *m;
    671   1.1       cgd {
    672   1.1       cgd 	register struct ip *ip = mtod(m, struct ip *);
    673   1.1       cgd 	register u_char *cp;
    674   1.1       cgd 	register struct ip_timestamp *ipt;
    675   1.1       cgd 	register struct in_ifaddr *ia;
    676   1.1       cgd 	int opt, optlen, cnt, off, code, type = ICMP_PARAMPROB, forward = 0;
    677  1.13   mycroft 	struct in_addr *sin, dst;
    678   1.1       cgd 	n_time ntime;
    679   1.1       cgd 
    680  1.13   mycroft 	dst = ip->ip_dst;
    681   1.1       cgd 	cp = (u_char *)(ip + 1);
    682   1.1       cgd 	cnt = (ip->ip_hl << 2) - sizeof (struct ip);
    683   1.1       cgd 	for (; cnt > 0; cnt -= optlen, cp += optlen) {
    684   1.1       cgd 		opt = cp[IPOPT_OPTVAL];
    685   1.1       cgd 		if (opt == IPOPT_EOL)
    686   1.1       cgd 			break;
    687   1.1       cgd 		if (opt == IPOPT_NOP)
    688   1.1       cgd 			optlen = 1;
    689   1.1       cgd 		else {
    690   1.1       cgd 			optlen = cp[IPOPT_OLEN];
    691   1.1       cgd 			if (optlen <= 0 || optlen > cnt) {
    692   1.1       cgd 				code = &cp[IPOPT_OLEN] - (u_char *)ip;
    693   1.1       cgd 				goto bad;
    694   1.1       cgd 			}
    695   1.1       cgd 		}
    696   1.1       cgd 		switch (opt) {
    697   1.1       cgd 
    698   1.1       cgd 		default:
    699   1.1       cgd 			break;
    700   1.1       cgd 
    701   1.1       cgd 		/*
    702   1.1       cgd 		 * Source routing with record.
    703   1.1       cgd 		 * Find interface with current destination address.
    704   1.1       cgd 		 * If none on this machine then drop if strictly routed,
    705   1.1       cgd 		 * or do nothing if loosely routed.
    706   1.1       cgd 		 * Record interface address and bring up next address
    707   1.1       cgd 		 * component.  If strictly routed make sure next
    708   1.1       cgd 		 * address is on directly accessible net.
    709   1.1       cgd 		 */
    710   1.1       cgd 		case IPOPT_LSRR:
    711   1.1       cgd 		case IPOPT_SSRR:
    712   1.1       cgd 			if ((off = cp[IPOPT_OFFSET]) < IPOPT_MINOFF) {
    713   1.1       cgd 				code = &cp[IPOPT_OFFSET] - (u_char *)ip;
    714   1.1       cgd 				goto bad;
    715   1.1       cgd 			}
    716   1.1       cgd 			ipaddr.sin_addr = ip->ip_dst;
    717  1.19   mycroft 			ia = ifatoia(ifa_ifwithaddr(sintosa(&ipaddr)));
    718   1.1       cgd 			if (ia == 0) {
    719   1.1       cgd 				if (opt == IPOPT_SSRR) {
    720   1.1       cgd 					type = ICMP_UNREACH;
    721   1.1       cgd 					code = ICMP_UNREACH_SRCFAIL;
    722   1.1       cgd 					goto bad;
    723   1.1       cgd 				}
    724   1.1       cgd 				/*
    725   1.1       cgd 				 * Loose routing, and not at next destination
    726   1.1       cgd 				 * yet; nothing to do except forward.
    727   1.1       cgd 				 */
    728   1.1       cgd 				break;
    729   1.1       cgd 			}
    730   1.1       cgd 			off--;			/* 0 origin */
    731   1.1       cgd 			if (off > optlen - sizeof(struct in_addr)) {
    732   1.1       cgd 				/*
    733   1.1       cgd 				 * End of source route.  Should be for us.
    734   1.1       cgd 				 */
    735   1.1       cgd 				save_rte(cp, ip->ip_src);
    736   1.1       cgd 				break;
    737   1.1       cgd 			}
    738   1.1       cgd 			/*
    739   1.1       cgd 			 * locate outgoing interface
    740   1.1       cgd 			 */
    741   1.1       cgd 			bcopy((caddr_t)(cp + off), (caddr_t)&ipaddr.sin_addr,
    742   1.1       cgd 			    sizeof(ipaddr.sin_addr));
    743   1.1       cgd 			if (opt == IPOPT_SSRR) {
    744   1.1       cgd #define	INA	struct in_ifaddr *
    745   1.1       cgd #define	SA	struct sockaddr *
    746  1.29       mrg 			    ia = (INA)ifa_ifwithladdr((SA)&ipaddr);
    747   1.1       cgd 			} else
    748   1.1       cgd 				ia = ip_rtaddr(ipaddr.sin_addr);
    749   1.1       cgd 			if (ia == 0) {
    750   1.1       cgd 				type = ICMP_UNREACH;
    751   1.1       cgd 				code = ICMP_UNREACH_SRCFAIL;
    752   1.1       cgd 				goto bad;
    753   1.1       cgd 			}
    754   1.1       cgd 			ip->ip_dst = ipaddr.sin_addr;
    755  1.20   mycroft 			bcopy((caddr_t)&ia->ia_addr.sin_addr,
    756   1.1       cgd 			    (caddr_t)(cp + off), sizeof(struct in_addr));
    757   1.1       cgd 			cp[IPOPT_OFFSET] += sizeof(struct in_addr);
    758  1.13   mycroft 			/*
    759  1.13   mycroft 			 * Let ip_intr's mcast routing check handle mcast pkts
    760  1.13   mycroft 			 */
    761  1.18   mycroft 			forward = !IN_MULTICAST(ip->ip_dst.s_addr);
    762   1.1       cgd 			break;
    763   1.1       cgd 
    764   1.1       cgd 		case IPOPT_RR:
    765   1.1       cgd 			if ((off = cp[IPOPT_OFFSET]) < IPOPT_MINOFF) {
    766   1.1       cgd 				code = &cp[IPOPT_OFFSET] - (u_char *)ip;
    767   1.1       cgd 				goto bad;
    768   1.1       cgd 			}
    769   1.1       cgd 			/*
    770   1.1       cgd 			 * If no space remains, ignore.
    771   1.1       cgd 			 */
    772   1.1       cgd 			off--;			/* 0 origin */
    773   1.1       cgd 			if (off > optlen - sizeof(struct in_addr))
    774   1.1       cgd 				break;
    775   1.1       cgd 			bcopy((caddr_t)(&ip->ip_dst), (caddr_t)&ipaddr.sin_addr,
    776   1.1       cgd 			    sizeof(ipaddr.sin_addr));
    777   1.1       cgd 			/*
    778   1.1       cgd 			 * locate outgoing interface; if we're the destination,
    779   1.1       cgd 			 * use the incoming interface (should be same).
    780   1.1       cgd 			 */
    781   1.1       cgd 			if ((ia = (INA)ifa_ifwithaddr((SA)&ipaddr)) == 0 &&
    782   1.1       cgd 			    (ia = ip_rtaddr(ipaddr.sin_addr)) == 0) {
    783   1.1       cgd 				type = ICMP_UNREACH;
    784   1.1       cgd 				code = ICMP_UNREACH_HOST;
    785   1.1       cgd 				goto bad;
    786   1.1       cgd 			}
    787  1.20   mycroft 			bcopy((caddr_t)&ia->ia_addr.sin_addr,
    788   1.1       cgd 			    (caddr_t)(cp + off), sizeof(struct in_addr));
    789   1.1       cgd 			cp[IPOPT_OFFSET] += sizeof(struct in_addr);
    790   1.1       cgd 			break;
    791   1.1       cgd 
    792   1.1       cgd 		case IPOPT_TS:
    793   1.1       cgd 			code = cp - (u_char *)ip;
    794   1.1       cgd 			ipt = (struct ip_timestamp *)cp;
    795   1.1       cgd 			if (ipt->ipt_len < 5)
    796   1.1       cgd 				goto bad;
    797  1.15       cgd 			if (ipt->ipt_ptr > ipt->ipt_len - sizeof (int32_t)) {
    798   1.1       cgd 				if (++ipt->ipt_oflw == 0)
    799   1.1       cgd 					goto bad;
    800   1.1       cgd 				break;
    801   1.1       cgd 			}
    802   1.1       cgd 			sin = (struct in_addr *)(cp + ipt->ipt_ptr - 1);
    803   1.1       cgd 			switch (ipt->ipt_flg) {
    804   1.1       cgd 
    805   1.1       cgd 			case IPOPT_TS_TSONLY:
    806   1.1       cgd 				break;
    807   1.1       cgd 
    808   1.1       cgd 			case IPOPT_TS_TSANDADDR:
    809   1.1       cgd 				if (ipt->ipt_ptr + sizeof(n_time) +
    810   1.1       cgd 				    sizeof(struct in_addr) > ipt->ipt_len)
    811   1.1       cgd 					goto bad;
    812  1.13   mycroft 				ipaddr.sin_addr = dst;
    813  1.13   mycroft 				ia = (INA)ifaof_ifpforaddr((SA)&ipaddr,
    814  1.13   mycroft 							    m->m_pkthdr.rcvif);
    815  1.13   mycroft 				if (ia == 0)
    816  1.13   mycroft 					continue;
    817  1.20   mycroft 				bcopy((caddr_t)&ia->ia_addr.sin_addr,
    818   1.1       cgd 				    (caddr_t)sin, sizeof(struct in_addr));
    819   1.1       cgd 				ipt->ipt_ptr += sizeof(struct in_addr);
    820   1.1       cgd 				break;
    821   1.1       cgd 
    822   1.1       cgd 			case IPOPT_TS_PRESPEC:
    823   1.1       cgd 				if (ipt->ipt_ptr + sizeof(n_time) +
    824   1.1       cgd 				    sizeof(struct in_addr) > ipt->ipt_len)
    825   1.1       cgd 					goto bad;
    826   1.1       cgd 				bcopy((caddr_t)sin, (caddr_t)&ipaddr.sin_addr,
    827   1.1       cgd 				    sizeof(struct in_addr));
    828   1.1       cgd 				if (ifa_ifwithaddr((SA)&ipaddr) == 0)
    829   1.1       cgd 					continue;
    830   1.1       cgd 				ipt->ipt_ptr += sizeof(struct in_addr);
    831   1.1       cgd 				break;
    832   1.1       cgd 
    833   1.1       cgd 			default:
    834   1.1       cgd 				goto bad;
    835   1.1       cgd 			}
    836   1.1       cgd 			ntime = iptime();
    837   1.1       cgd 			bcopy((caddr_t)&ntime, (caddr_t)cp + ipt->ipt_ptr - 1,
    838   1.1       cgd 			    sizeof(n_time));
    839   1.1       cgd 			ipt->ipt_ptr += sizeof(n_time);
    840   1.1       cgd 		}
    841   1.1       cgd 	}
    842   1.1       cgd 	if (forward) {
    843  1.26   thorpej 		if (ip_forwsrcrt == 0) {
    844  1.26   thorpej 			type = ICMP_UNREACH;
    845  1.26   thorpej 			code = ICMP_UNREACH_SRCFAIL;
    846  1.26   thorpej 			goto bad;
    847  1.26   thorpej 		}
    848   1.1       cgd 		ip_forward(m, 1);
    849   1.1       cgd 		return (1);
    850  1.13   mycroft 	}
    851  1.13   mycroft 	return (0);
    852   1.1       cgd bad:
    853  1.13   mycroft 	ip->ip_len -= ip->ip_hl << 2;   /* XXX icmp_error adds in hdr length */
    854  1.13   mycroft 	icmp_error(m, type, code, 0, 0);
    855  1.13   mycroft 	ipstat.ips_badoptions++;
    856   1.1       cgd 	return (1);
    857   1.1       cgd }
    858   1.1       cgd 
    859   1.1       cgd /*
    860   1.1       cgd  * Given address of next destination (final or next hop),
    861   1.1       cgd  * return internet address info of interface to be used to get there.
    862   1.1       cgd  */
    863   1.1       cgd struct in_ifaddr *
    864   1.1       cgd ip_rtaddr(dst)
    865   1.1       cgd 	 struct in_addr dst;
    866   1.1       cgd {
    867   1.1       cgd 	register struct sockaddr_in *sin;
    868   1.1       cgd 
    869  1.19   mycroft 	sin = satosin(&ipforward_rt.ro_dst);
    870   1.1       cgd 
    871  1.35   mycroft 	if (ipforward_rt.ro_rt == 0 || !in_hosteq(dst, sin->sin_addr)) {
    872   1.1       cgd 		if (ipforward_rt.ro_rt) {
    873   1.1       cgd 			RTFREE(ipforward_rt.ro_rt);
    874   1.1       cgd 			ipforward_rt.ro_rt = 0;
    875   1.1       cgd 		}
    876   1.1       cgd 		sin->sin_family = AF_INET;
    877   1.1       cgd 		sin->sin_len = sizeof(*sin);
    878   1.1       cgd 		sin->sin_addr = dst;
    879   1.1       cgd 
    880   1.1       cgd 		rtalloc(&ipforward_rt);
    881   1.1       cgd 	}
    882   1.1       cgd 	if (ipforward_rt.ro_rt == 0)
    883   1.1       cgd 		return ((struct in_ifaddr *)0);
    884  1.19   mycroft 	return (ifatoia(ipforward_rt.ro_rt->rt_ifa));
    885   1.1       cgd }
    886   1.1       cgd 
    887   1.1       cgd /*
    888   1.1       cgd  * Save incoming source route for use in replies,
    889   1.1       cgd  * to be picked up later by ip_srcroute if the receiver is interested.
    890   1.1       cgd  */
    891  1.13   mycroft void
    892   1.1       cgd save_rte(option, dst)
    893   1.1       cgd 	u_char *option;
    894   1.1       cgd 	struct in_addr dst;
    895   1.1       cgd {
    896   1.1       cgd 	unsigned olen;
    897   1.1       cgd 
    898   1.1       cgd 	olen = option[IPOPT_OLEN];
    899   1.1       cgd #ifdef DIAGNOSTIC
    900   1.1       cgd 	if (ipprintfs)
    901   1.1       cgd 		printf("save_rte: olen %d\n", olen);
    902   1.1       cgd #endif
    903   1.1       cgd 	if (olen > sizeof(ip_srcrt) - (1 + sizeof(dst)))
    904   1.1       cgd 		return;
    905   1.1       cgd 	bcopy((caddr_t)option, (caddr_t)ip_srcrt.srcopt, olen);
    906   1.1       cgd 	ip_nhops = (olen - IPOPT_OFFSET - 1) / sizeof(struct in_addr);
    907   1.1       cgd 	ip_srcrt.dst = dst;
    908   1.1       cgd }
    909   1.1       cgd 
    910   1.1       cgd /*
    911   1.1       cgd  * Retrieve incoming source route for use in replies,
    912   1.1       cgd  * in the same form used by setsockopt.
    913   1.1       cgd  * The first hop is placed before the options, will be removed later.
    914   1.1       cgd  */
    915   1.1       cgd struct mbuf *
    916   1.1       cgd ip_srcroute()
    917   1.1       cgd {
    918   1.1       cgd 	register struct in_addr *p, *q;
    919   1.1       cgd 	register struct mbuf *m;
    920   1.1       cgd 
    921   1.1       cgd 	if (ip_nhops == 0)
    922   1.1       cgd 		return ((struct mbuf *)0);
    923   1.1       cgd 	m = m_get(M_DONTWAIT, MT_SOOPTS);
    924   1.1       cgd 	if (m == 0)
    925   1.1       cgd 		return ((struct mbuf *)0);
    926   1.1       cgd 
    927  1.13   mycroft #define OPTSIZ	(sizeof(ip_srcrt.nop) + sizeof(ip_srcrt.srcopt))
    928   1.1       cgd 
    929   1.1       cgd 	/* length is (nhops+1)*sizeof(addr) + sizeof(nop + srcrt header) */
    930   1.1       cgd 	m->m_len = ip_nhops * sizeof(struct in_addr) + sizeof(struct in_addr) +
    931   1.1       cgd 	    OPTSIZ;
    932   1.1       cgd #ifdef DIAGNOSTIC
    933   1.1       cgd 	if (ipprintfs)
    934   1.1       cgd 		printf("ip_srcroute: nhops %d mlen %d", ip_nhops, m->m_len);
    935   1.1       cgd #endif
    936   1.1       cgd 
    937   1.1       cgd 	/*
    938   1.1       cgd 	 * First save first hop for return route
    939   1.1       cgd 	 */
    940   1.1       cgd 	p = &ip_srcrt.route[ip_nhops - 1];
    941   1.1       cgd 	*(mtod(m, struct in_addr *)) = *p--;
    942   1.1       cgd #ifdef DIAGNOSTIC
    943   1.1       cgd 	if (ipprintfs)
    944  1.32   thorpej 		printf(" hops %x", ntohl(mtod(m, struct in_addr *)->s_addr));
    945   1.1       cgd #endif
    946   1.1       cgd 
    947   1.1       cgd 	/*
    948   1.1       cgd 	 * Copy option fields and padding (nop) to mbuf.
    949   1.1       cgd 	 */
    950   1.1       cgd 	ip_srcrt.nop = IPOPT_NOP;
    951   1.1       cgd 	ip_srcrt.srcopt[IPOPT_OFFSET] = IPOPT_MINOFF;
    952   1.1       cgd 	bcopy((caddr_t)&ip_srcrt.nop,
    953   1.1       cgd 	    mtod(m, caddr_t) + sizeof(struct in_addr), OPTSIZ);
    954   1.1       cgd 	q = (struct in_addr *)(mtod(m, caddr_t) +
    955   1.1       cgd 	    sizeof(struct in_addr) + OPTSIZ);
    956   1.1       cgd #undef OPTSIZ
    957   1.1       cgd 	/*
    958   1.1       cgd 	 * Record return path as an IP source route,
    959   1.1       cgd 	 * reversing the path (pointers are now aligned).
    960   1.1       cgd 	 */
    961   1.1       cgd 	while (p >= ip_srcrt.route) {
    962   1.1       cgd #ifdef DIAGNOSTIC
    963   1.1       cgd 		if (ipprintfs)
    964  1.32   thorpej 			printf(" %x", ntohl(q->s_addr));
    965   1.1       cgd #endif
    966   1.1       cgd 		*q++ = *p--;
    967   1.1       cgd 	}
    968   1.1       cgd 	/*
    969   1.1       cgd 	 * Last hop goes to final destination.
    970   1.1       cgd 	 */
    971   1.1       cgd 	*q = ip_srcrt.dst;
    972   1.1       cgd #ifdef DIAGNOSTIC
    973   1.1       cgd 	if (ipprintfs)
    974  1.32   thorpej 		printf(" %x\n", ntohl(q->s_addr));
    975   1.1       cgd #endif
    976   1.1       cgd 	return (m);
    977   1.1       cgd }
    978   1.1       cgd 
    979   1.1       cgd /*
    980   1.1       cgd  * Strip out IP options, at higher
    981   1.1       cgd  * level protocol in the kernel.
    982   1.1       cgd  * Second argument is buffer to which options
    983   1.1       cgd  * will be moved, and return value is their length.
    984   1.1       cgd  * XXX should be deleted; last arg currently ignored.
    985   1.1       cgd  */
    986   1.8   mycroft void
    987   1.1       cgd ip_stripoptions(m, mopt)
    988   1.1       cgd 	register struct mbuf *m;
    989   1.1       cgd 	struct mbuf *mopt;
    990   1.1       cgd {
    991   1.1       cgd 	register int i;
    992   1.1       cgd 	struct ip *ip = mtod(m, struct ip *);
    993   1.1       cgd 	register caddr_t opts;
    994   1.1       cgd 	int olen;
    995   1.1       cgd 
    996   1.1       cgd 	olen = (ip->ip_hl<<2) - sizeof (struct ip);
    997   1.1       cgd 	opts = (caddr_t)(ip + 1);
    998   1.1       cgd 	i = m->m_len - (sizeof (struct ip) + olen);
    999   1.1       cgd 	bcopy(opts  + olen, opts, (unsigned)i);
   1000   1.1       cgd 	m->m_len -= olen;
   1001   1.1       cgd 	if (m->m_flags & M_PKTHDR)
   1002   1.1       cgd 		m->m_pkthdr.len -= olen;
   1003   1.1       cgd 	ip->ip_hl = sizeof(struct ip) >> 2;
   1004   1.1       cgd }
   1005   1.1       cgd 
   1006  1.23   mycroft int inetctlerrmap[PRC_NCMDS] = {
   1007   1.1       cgd 	0,		0,		0,		0,
   1008   1.1       cgd 	0,		EMSGSIZE,	EHOSTDOWN,	EHOSTUNREACH,
   1009   1.1       cgd 	EHOSTUNREACH,	EHOSTUNREACH,	ECONNREFUSED,	ECONNREFUSED,
   1010   1.1       cgd 	EMSGSIZE,	EHOSTUNREACH,	0,		0,
   1011   1.1       cgd 	0,		0,		0,		0,
   1012   1.1       cgd 	ENOPROTOOPT
   1013   1.1       cgd };
   1014   1.1       cgd 
   1015   1.1       cgd /*
   1016   1.1       cgd  * Forward a packet.  If some error occurs return the sender
   1017   1.1       cgd  * an icmp packet.  Note we can't always generate a meaningful
   1018   1.1       cgd  * icmp message because icmp doesn't have a large enough repertoire
   1019   1.1       cgd  * of codes and types.
   1020   1.1       cgd  *
   1021   1.1       cgd  * If not forwarding, just drop the packet.  This could be confusing
   1022   1.1       cgd  * if ipforwarding was zero but some routing protocol was advancing
   1023   1.1       cgd  * us as a gateway to somewhere.  However, we must let the routing
   1024   1.1       cgd  * protocol deal with that.
   1025   1.1       cgd  *
   1026   1.1       cgd  * The srcrt parameter indicates whether the packet is being forwarded
   1027   1.1       cgd  * via a source route.
   1028   1.1       cgd  */
   1029  1.13   mycroft void
   1030   1.1       cgd ip_forward(m, srcrt)
   1031   1.1       cgd 	struct mbuf *m;
   1032   1.1       cgd 	int srcrt;
   1033   1.1       cgd {
   1034   1.1       cgd 	register struct ip *ip = mtod(m, struct ip *);
   1035   1.1       cgd 	register struct sockaddr_in *sin;
   1036   1.1       cgd 	register struct rtentry *rt;
   1037  1.28  christos 	int error, type = 0, code = 0;
   1038   1.1       cgd 	struct mbuf *mcopy;
   1039  1.13   mycroft 	n_long dest;
   1040  1.13   mycroft 	struct ifnet *destifp;
   1041   1.1       cgd 
   1042  1.13   mycroft 	dest = 0;
   1043   1.1       cgd #ifdef DIAGNOSTIC
   1044   1.1       cgd 	if (ipprintfs)
   1045  1.28  christos 		printf("forward: src %x dst %x ttl %x\n",
   1046  1.35   mycroft 		    ip->ip_src.s_addr, ip->ip_dst.s_addr, ip->ip_ttl);
   1047   1.1       cgd #endif
   1048   1.1       cgd 	if (m->m_flags & M_BCAST || in_canforward(ip->ip_dst) == 0) {
   1049   1.1       cgd 		ipstat.ips_cantforward++;
   1050   1.1       cgd 		m_freem(m);
   1051   1.1       cgd 		return;
   1052   1.1       cgd 	}
   1053   1.1       cgd 	HTONS(ip->ip_id);
   1054   1.1       cgd 	if (ip->ip_ttl <= IPTTLDEC) {
   1055  1.13   mycroft 		icmp_error(m, ICMP_TIMXCEED, ICMP_TIMXCEED_INTRANS, dest, 0);
   1056   1.1       cgd 		return;
   1057   1.1       cgd 	}
   1058   1.1       cgd 	ip->ip_ttl -= IPTTLDEC;
   1059   1.1       cgd 
   1060  1.19   mycroft 	sin = satosin(&ipforward_rt.ro_dst);
   1061   1.1       cgd 	if ((rt = ipforward_rt.ro_rt) == 0 ||
   1062  1.35   mycroft 	    !in_hosteq(ip->ip_dst, sin->sin_addr)) {
   1063   1.1       cgd 		if (ipforward_rt.ro_rt) {
   1064   1.1       cgd 			RTFREE(ipforward_rt.ro_rt);
   1065   1.1       cgd 			ipforward_rt.ro_rt = 0;
   1066   1.1       cgd 		}
   1067   1.1       cgd 		sin->sin_family = AF_INET;
   1068  1.35   mycroft 		sin->sin_len = sizeof(struct sockaddr_in);
   1069   1.1       cgd 		sin->sin_addr = ip->ip_dst;
   1070   1.1       cgd 
   1071   1.1       cgd 		rtalloc(&ipforward_rt);
   1072   1.1       cgd 		if (ipforward_rt.ro_rt == 0) {
   1073  1.13   mycroft 			icmp_error(m, ICMP_UNREACH, ICMP_UNREACH_HOST, dest, 0);
   1074   1.1       cgd 			return;
   1075   1.1       cgd 		}
   1076   1.1       cgd 		rt = ipforward_rt.ro_rt;
   1077   1.1       cgd 	}
   1078   1.1       cgd 
   1079   1.1       cgd 	/*
   1080  1.34   mycroft 	 * Save at most 68 bytes of the packet in case
   1081   1.1       cgd 	 * we need to generate an ICMP message to the src.
   1082   1.1       cgd 	 */
   1083  1.34   mycroft 	mcopy = m_copy(m, 0, imin((int)ip->ip_len, 68));
   1084   1.1       cgd 
   1085   1.1       cgd 	/*
   1086   1.1       cgd 	 * If forwarding packet using same interface that it came in on,
   1087   1.1       cgd 	 * perhaps should send a redirect to sender to shortcut a hop.
   1088   1.1       cgd 	 * Only send redirect if source is sending directly to us,
   1089   1.1       cgd 	 * and if packet was not source routed (or has any options).
   1090   1.1       cgd 	 * Also, don't send redirect if forwarding using a default route
   1091   1.1       cgd 	 * or a route modified by a redirect.
   1092   1.1       cgd 	 */
   1093   1.1       cgd 	if (rt->rt_ifp == m->m_pkthdr.rcvif &&
   1094   1.1       cgd 	    (rt->rt_flags & (RTF_DYNAMIC|RTF_MODIFIED)) == 0 &&
   1095  1.35   mycroft 	    !in_nullhost(satosin(rt_key(rt))->sin_addr) &&
   1096   1.1       cgd 	    ipsendredirects && !srcrt) {
   1097  1.19   mycroft 		if (rt->rt_ifa &&
   1098  1.19   mycroft 		    (ip->ip_src.s_addr & ifatoia(rt->rt_ifa)->ia_subnetmask) ==
   1099  1.19   mycroft 		    ifatoia(rt->rt_ifa)->ia_subnet) {
   1100   1.1       cgd 		    if (rt->rt_flags & RTF_GATEWAY)
   1101  1.13   mycroft 			dest = satosin(rt->rt_gateway)->sin_addr.s_addr;
   1102   1.1       cgd 		    else
   1103  1.13   mycroft 			dest = ip->ip_dst.s_addr;
   1104  1.13   mycroft 		    /* Router requirements says to only send host redirects */
   1105   1.1       cgd 		    type = ICMP_REDIRECT;
   1106  1.13   mycroft 		    code = ICMP_REDIRECT_HOST;
   1107   1.1       cgd #ifdef DIAGNOSTIC
   1108   1.1       cgd 		    if (ipprintfs)
   1109  1.35   mycroft 		    	printf("redirect (%d) to %x\n", code, (u_int32_t)dest);
   1110   1.1       cgd #endif
   1111   1.1       cgd 		}
   1112   1.1       cgd 	}
   1113   1.1       cgd 
   1114  1.27   thorpej 	error = ip_output(m, (struct mbuf *)0, &ipforward_rt,
   1115  1.27   thorpej 	    (IP_FORWARDING | (ip_directedbcast ? IP_ALLOWBROADCAST : 0)), 0);
   1116   1.1       cgd 	if (error)
   1117   1.1       cgd 		ipstat.ips_cantforward++;
   1118   1.1       cgd 	else {
   1119   1.1       cgd 		ipstat.ips_forward++;
   1120   1.1       cgd 		if (type)
   1121   1.1       cgd 			ipstat.ips_redirectsent++;
   1122   1.1       cgd 		else {
   1123   1.1       cgd 			if (mcopy)
   1124   1.1       cgd 				m_freem(mcopy);
   1125   1.1       cgd 			return;
   1126   1.1       cgd 		}
   1127   1.1       cgd 	}
   1128   1.1       cgd 	if (mcopy == NULL)
   1129   1.1       cgd 		return;
   1130  1.13   mycroft 	destifp = NULL;
   1131  1.13   mycroft 
   1132   1.1       cgd 	switch (error) {
   1133   1.1       cgd 
   1134   1.1       cgd 	case 0:				/* forwarded, but need redirect */
   1135   1.1       cgd 		/* type, code set above */
   1136   1.1       cgd 		break;
   1137   1.1       cgd 
   1138   1.1       cgd 	case ENETUNREACH:		/* shouldn't happen, checked above */
   1139   1.1       cgd 	case EHOSTUNREACH:
   1140   1.1       cgd 	case ENETDOWN:
   1141   1.1       cgd 	case EHOSTDOWN:
   1142   1.1       cgd 	default:
   1143   1.1       cgd 		type = ICMP_UNREACH;
   1144   1.1       cgd 		code = ICMP_UNREACH_HOST;
   1145   1.1       cgd 		break;
   1146   1.1       cgd 
   1147   1.1       cgd 	case EMSGSIZE:
   1148   1.1       cgd 		type = ICMP_UNREACH;
   1149   1.1       cgd 		code = ICMP_UNREACH_NEEDFRAG;
   1150  1.13   mycroft 		if (ipforward_rt.ro_rt)
   1151  1.13   mycroft 			destifp = ipforward_rt.ro_rt->rt_ifp;
   1152   1.1       cgd 		ipstat.ips_cantfrag++;
   1153   1.1       cgd 		break;
   1154   1.1       cgd 
   1155   1.1       cgd 	case ENOBUFS:
   1156   1.1       cgd 		type = ICMP_SOURCEQUENCH;
   1157   1.1       cgd 		code = 0;
   1158   1.1       cgd 		break;
   1159   1.1       cgd 	}
   1160  1.13   mycroft 	icmp_error(mcopy, type, code, dest, destifp);
   1161  1.13   mycroft }
   1162  1.13   mycroft 
   1163  1.13   mycroft int
   1164  1.13   mycroft ip_sysctl(name, namelen, oldp, oldlenp, newp, newlen)
   1165  1.13   mycroft 	int *name;
   1166  1.13   mycroft 	u_int namelen;
   1167  1.13   mycroft 	void *oldp;
   1168  1.13   mycroft 	size_t *oldlenp;
   1169  1.13   mycroft 	void *newp;
   1170  1.13   mycroft 	size_t newlen;
   1171  1.13   mycroft {
   1172  1.13   mycroft 	/* All sysctl names at this level are terminal. */
   1173  1.13   mycroft 	if (namelen != 1)
   1174  1.13   mycroft 		return (ENOTDIR);
   1175  1.13   mycroft 
   1176  1.13   mycroft 	switch (name[0]) {
   1177  1.13   mycroft 	case IPCTL_FORWARDING:
   1178  1.13   mycroft 		return (sysctl_int(oldp, oldlenp, newp, newlen, &ipforwarding));
   1179  1.13   mycroft 	case IPCTL_SENDREDIRECTS:
   1180  1.13   mycroft 		return (sysctl_int(oldp, oldlenp, newp, newlen,
   1181  1.13   mycroft 			&ipsendredirects));
   1182  1.13   mycroft 	case IPCTL_DEFTTL:
   1183  1.13   mycroft 		return (sysctl_int(oldp, oldlenp, newp, newlen, &ip_defttl));
   1184  1.13   mycroft #ifdef notyet
   1185  1.13   mycroft 	case IPCTL_DEFMTU:
   1186  1.13   mycroft 		return (sysctl_int(oldp, oldlenp, newp, newlen, &ip_mtu));
   1187  1.13   mycroft #endif
   1188  1.26   thorpej 	case IPCTL_FORWSRCRT:
   1189  1.26   thorpej 		/*
   1190  1.26   thorpej 		 * Don't allow this to change in a secure environment.
   1191  1.26   thorpej 		 */
   1192  1.26   thorpej 		if (securelevel > 0)
   1193  1.26   thorpej 			return (EPERM);
   1194  1.26   thorpej 		return (sysctl_int(oldp, oldlenp, newp, newlen,
   1195  1.26   thorpej 		    &ip_forwsrcrt));
   1196  1.27   thorpej 	case IPCTL_DIRECTEDBCAST:
   1197  1.27   thorpej 		return (sysctl_int(oldp, oldlenp, newp, newlen,
   1198  1.27   thorpej 		    &ip_directedbcast));
   1199  1.13   mycroft 	default:
   1200  1.13   mycroft 		return (EOPNOTSUPP);
   1201  1.13   mycroft 	}
   1202  1.13   mycroft 	/* NOTREACHED */
   1203   1.1       cgd }
   1204