raw_ip.c

VXWORKS源代码

/* raw_ip.c - raw interface to IP protocol */

/* Copyright 1984 - 2002 Wind River Systems, Inc. */
#include "copyright_wrs.h"

/*
 * Copyright (c) 1982, 1986, 1988, 1993, 1995
 *	The Regents of the University of California.  All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 * 3. All advertising materials mentioning features or use of this software
 *    must display the following acknowledgement:
 *	This product includes software developed by the University of
 *	California, Berkeley and its contributors.
 * 4. Neither the name of the University nor the names of its contributors
 *    may be used to endorse or promote products derived from this software
 *    without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
 * SUCH DAMAGE.
 *
 *	@(#)raw_ip.c	8.7 (Berkeley) 5/15/95
 */

/*
modification history
--------------------
01j,20may02,vvv  fixed rip_input to send ICMP protocol unreachable errors 
		 only when called directly from ip_input (SPR #75405)
01i,21mar02,rae  Allow ICMP to be excluded (SPR #73703)
01h,12oct01,rae  merge from truestack ver 01o, base 01g (SPRs 69657,
                 35258, etc)
01g,26aug98,n_s  corrected rip_output for IP_HDRINCL case. spr #22246
01f,26aug98,n_s  added return val check for M_PREPEND in rip_output and
                 mBufClGet in rip_ctloutput. spr # 22238.
01e,16apr97,vin	 added PRU_CONTROL support to rip_usrreq().
01d,08apr97,vin  include pcb hashing changes from FREEBSD2.2.1, removed
		 ip_mrouter, added mCastRouteCmdHook. removed all MROUTING
01c,31jan97,vin  changed declaration according to prototype decl in protosw.h
01b,22nov96,vin  added cluster support replaced m_get(..) with mBufClGet(..).
01a,03mar96,vin  created from BSD4.4 stuff,integrated with 02i of raw_usrreq.c
*/

/*
DESCRIPTION
*/

#include "vxWorks.h"
#include "net/mbuf.h"
#include "sys/socket.h"
#include "net/protosw.h"
#include "net/socketvar.h"
#include "errno.h"

#include "net/if.h"
#include "net/route.h"
#include "net/raw_cb.h"

#include "netinet/in.h"
#include "netinet/in_systm.h"
#include "netinet/in_var.h"
#include "netinet/ip.h"
#include "netinet/ip_icmp.h"
#include "netinet/ip_var.h"
#include "netinet/ip_mroute.h"
#include "netinet/in_pcb.h"

#ifdef WV_INSTRUMENTATION
#ifdef INCLUDE_WVNET
#include "wvNetLib.h"
#endif
#endif

/* externs */
extern FUNCPTR _mCastRouteCmdHook;	/* WRS mcast route command hook */
extern VOIDFUNCPTR _icmpErrorHook;
extern int icmp_ctloutput (int, struct socket *, int, int, struct mbuf **);
extern struct protosw inetsw[];
extern u_char ip_protox[IPPROTO_MAX];

/* globals */

#ifndef VIRTUAL_STACK
static struct inpcbhead ripcb;
static struct inpcbinfo ripcbinfo;
static struct sockaddr_in ripsrc = { sizeof(ripsrc), AF_INET };
#endif /* VIRTUAL_STACK */

#ifdef VIRTUAL_STACK
#include "netinet/vsLib.h"
#endif

/*
 * Nominal space allocated to a raw ip socket.
 */
#define	RIPSNDQ		8192
#define	RIPRCVQ		8192

/* locals */
static int _mCastCtlOutput (int option, int optName, struct socket * sockPtr,
                            struct mbuf ** pPtrMbuf); 

#ifdef WV_INSTRUMENTATION
#ifdef INCLUDE_WVNET
    /* Set common fields of event identifiers for this module. */

LOCAL UCHAR wvNetModuleId = WV_NET_RAWIP_MODULE;   /* Value for raw_ip.c */
LOCAL UCHAR wvNetLocalFilter = WV_NET_NONE;     /* Available event filter */

LOCAL ULONG wvNetEventId;       /* Event identifier: see wvNetLib.h */
#endif    /* INCLUDE_WVNET */
#endif

/*
 * Raw interface to IP protocol.
 */

/*
 * Initialize raw connection block q.
 */
void
rip_init()
{
#ifdef WV_INSTRUMENTATION
#ifdef INCLUDE_WVNET    /* WV_NET_VERBOSE event */
    WV_NET_MARKER_0 (NET_AUX_EVENT, WV_NET_VERBOSE, 31, 11,
                     WV_NETEVENT_RAWIPINIT_START)
#endif  /* INCLUDE_WVNET */
#endif

	LIST_INIT(&ripcb);
        ripcbinfo.listhead = &ripcb;
        /*
         * XXX We don't use the hash list for raw IP, but it's easier
         * to allocate a one entry hash list than it is to check all
         * over the place for hashbase == NULL.
         */
        ripcbinfo.hashbase = hashinit(1, MT_PCB, &ripcbinfo.hashmask);

#ifdef VIRTUAL_STACK
        rip_sendspace = RIPSNDQ;
        rip_recvspace = RIPRCVQ;
        ripsrc.sin_len = sizeof(struct sockaddr_in);
        ripsrc.sin_family = AF_INET;
#endif /* VIRTUAL_STACK */
}

/*
 * Setup generic address and protocol structures
 * for raw_input routine, then pass them along with
 * mbuf chain.
 */
void
rip_input(m)
	struct mbuf *m;
{
	register struct ip *ip = mtod(m, struct ip *);
	register struct inpcb *inp;
	struct socket *last = 0;

#ifdef WV_INSTRUMENTATION
#ifdef INCLUDE_WVNET    /* WV_NET_NOTICE event */
    WV_NET_EVENT_0 (NET_CORE_EVENT, WV_NET_NOTICE, 14, 7,
                     WV_NETEVENT_RAWIPIN_START, WV_NET_RECV)
#endif  /* INCLUDE_WVNET */
#endif

	ripsrc.sin_addr = ip->ip_src;
        * (int *)ripsrc.sin_zero = m->m_pkthdr.rcvif->if_index;
        for (inp = ripcb.lh_first; inp != NULL; inp = inp->inp_list.le_next) {
		if (inp->inp_ip.ip_p && inp->inp_ip.ip_p != ip->ip_p)
			continue;
		if (inp->inp_laddr.s_addr &&
		    inp->inp_laddr.s_addr != ip->ip_dst.s_addr)
			continue;
		if (inp->inp_faddr.s_addr &&
		    inp->inp_faddr.s_addr != ip->ip_src.s_addr)
			continue;
		if (last) {
			struct mbuf *n;
			if ((n = m_copy(m, 0, (int)M_COPYALL))) {
				if (sbappendaddr(&last->so_rcv,
				    (struct sockaddr *)&ripsrc, n,
				    (struct mbuf *)0) == 0)
                                    {
#ifdef WV_INSTRUMENTATION
#ifdef INCLUDE_WVNET    /* WV_NET_WARNING event */
                WV_NET_ADDRIN_EVENT_3 (NET_CORE_EVENT, WV_NET_WARNING, 9, 6,
                                       ip->ip_src.s_addr, ip->ip_dst.s_addr,
                                       WV_NETEVENT_RAWIPIN_LOST, WV_NET_RECV,
                                       last->so_fd, ip->ip_src.s_addr,
                                       ip->ip_dst.s_addr)
#endif  /* INCLUDE_WVNET */
#endif

					/* should notify about lost packet */
					m_freem(n);
                                    }
				else
					sorwakeup(last);
			}
		}
		last = inp->inp_socket;
	}
	if (last) {
		if (sbappendaddr(&last->so_rcv, (struct sockaddr *)&ripsrc,
		    m, (struct mbuf *)0) == 0)
                    {
#ifdef WV_INSTRUMENTATION
#ifdef INCLUDE_WVNET    /* WV_NET_WARNING event */
                WV_NET_ADDRIN_EVENT_3 (NET_CORE_EVENT, WV_NET_WARNING, 9, 6,
                                       ip->ip_src.s_addr, ip->ip_dst.s_addr,
                                       WV_NETEVENT_RAWIPIN_LOST, WV_NET_RECV,
                                       last->so_fd, ip->ip_src.s_addr,
                                       ip->ip_dst.s_addr)
#endif  /* INCLUDE_WVNET */
#endif

			m_freem(m);
                    }
		else
			sorwakeup(last);
	} else {
#ifdef WV_INSTRUMENTATION
#ifdef INCLUDE_WVNET    /* WV_NET_ERROR event */
            WV_NET_ADDRIN_EVENT_2 (NET_CORE_EVENT, WV_NET_ERROR, 35, 5,
                                   ip->ip_src.s_addr, ip->ip_dst.s_addr,
                                   WV_NETEVENT_RAWIPIN_NOSOCK, WV_NET_RECV,
                                   ip->ip_src.s_addr, ip->ip_dst.s_addr)
#endif  /* INCLUDE_WVNET */
#endif

                if ((_icmpErrorHook) && 
		    (inetsw[ip_protox[ip->ip_p]].pr_protocol == IPPROTO_RAW))
                    _icmpErrorHook (m, ICMP_UNREACH, ICMP_UNREACH_PROTOCOL, 
                                    ip->ip_src.s_addr, 0);
		m_freem(m);

#ifdef VIRTUAL_STACK
		_ipstat.ips_noproto++;
		_ipstat.ips_delivered--;
#else
		ipstat.ips_noproto++;
		ipstat.ips_delivered--;
#endif /* VIRTUAL_STACK */
	}
	return;
}

/*
 * Generate IP header and pass packet to ip_output.
 * Tack on options user may have setup with control call.
 */
int
rip_output(m, so, dst)
	register struct mbuf *m;
	struct socket *so;
	u_long dst;
{
	register struct ip *ip;
	register struct inpcb *inp = sotoinpcb(so);
	struct mbuf *opts;
	int flags = (so->so_options & SO_DONTROUTE) | IP_ALLOWBROADCAST;
        int result;

	/*
	 * If the user handed us a complete IP packet, use it.
	 * Otherwise, allocate an mbuf for a header and fill it in.
	 */
	if ((inp->inp_flags & INP_HDRINCL) == 0) {
		M_PREPEND(m, sizeof(struct ip), M_WAIT);
		if (m == (struct mbuf *) NULL)
		    {
		    return (ENOBUFS);
		    }
		    
		ip = mtod(m, struct ip *);
		ip->ip_tos = 0;
		ip->ip_off = 0;
		ip->ip_p = inp->inp_ip.ip_p;
		ip->ip_len = m->m_pkthdr.len;
		ip->ip_src = inp->inp_laddr;
		ip->ip_dst.s_addr = dst;
		ip->ip_ttl = inp->inp_ip.ip_ttl;

		opts = inp->inp_options;
	} else {
	        if (m->m_len < sizeof (struct ip) &&
		    (m = m_pullup (m, sizeof (struct ip))) == NULL)
		    {
		    return (ENOBUFS);
		    }

		ip = mtod(m, struct ip *);
		if (ip->ip_id == 0)
#ifdef VIRTUAL_STACK
			ip->ip_id = htons(_ip_id++);
#else
			ip->ip_id = htons(ip_id++);
#endif /* VIRTUAL_STACK */
		opts = NULL;
		/* XXX prevent ip_output from overwriting header fields */
		flags |= IP_RAWOUTPUT;
#ifdef VIRTUAL_STACK
		_ipstat.ips_rawout++;
#else
		ipstat.ips_rawout++;
#endif /* VIRTUAL_STACK */
	}
    result = ip_output(m, opts, &inp->inp_route, flags, inp->inp_moptions);

#ifdef WV_INSTRUMENTATION
#ifdef INCLUDE_WVNET    /* WV_NET_NOTICE event */
    WV_NET_ADDROUT_EVENT_3 (NET_CORE_EVENT, WV_NET_NOTICE, 15, 8,
                            inp->inp_laddr.s_addr, dst,
                            WV_NETEVENT_RAWIPOUT_FINISH, WV_NET_SEND,
                            result, inp->inp_laddr.s_addr, dst)
#endif  /* INCLUDE_WVNET */
#endif

    return (result);
}

/*
 * Raw IP socket option processing.
 */
int
rip_ctloutput(op, so, level, optname, m)