xref: /csrg-svn/sys/deprecated/netpup/raw_pup.c (revision 17056)

/*	raw_pup.c	6.2	84/08/29	*/

#include "param.h"
#include "mbuf.h"
#include "socket.h"
#include "protosw.h"
#include "socketvar.h"
#include "errno.h"

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

#include "../netpup/pup.h"

/*
 * Raw PUP protocol interface.
 */

struct	sockaddr_pup pupsrc = { AF_PUP };
struct	sockaddr_pup pupdst = { AF_PUP };
struct	sockproto pupproto = { PF_PUP };
/*
 * Raw PUP input.
 */
rpup_input(m)
	struct mbuf *m;
{
	register struct pup_header *pup = mtod(m, struct pup_header *);

	pupproto.sp_protocol = pup->pup_type;
	bcopy((caddr_t)&pup->pup_dnet, (caddr_t)&pupdst.spup_net,
	    sizeof (struct pupport));
	bcopy((caddr_t)&pup->pup_snet, (caddr_t)&pupsrc.spup_net,
	    sizeof (struct pupport));
	raw_input(m, &pupproto, (struct sockaddr *)&pupsrc,
	  (struct sockaddr *)&pupdst);
}

/*
 * Encapsulate packet in PUP header which is supplied by the
 * user.  This is done to allow user to specify PUP identifier.
 */
rpup_output(m, so)
	register struct mbuf *m;
	struct socket *so;
{
	register struct rawcb *rp = sotorawcb(so);
	register struct pup_header *pup;
	int len, error = 0;
	register struct mbuf *n, *last;
	struct sockaddr_pup *dst;
	struct ifnet *ifp;
	u_short *pc;

	/*
	 * Verify user has supplied necessary space
	 * for the header and check parameters in it.
	 */
	if ((m->m_off > MMAXOFF || m->m_len < sizeof(struct pup_header)) &&
	    (m = m_pullup(m, sizeof(struct pup_header))) == 0) {
		error = EINVAL;
		goto bad;
	}
	pup = mtod(m, struct pup_header *);
	if (pup->pup_type == 0 || (pup->pup_tcontrol &~ PUP_TRACE)) {
		error = EINVAL;
		goto bad;
	}
	for (len = 0, n = last = m; n; last = n, n = n->m_next)
		len += n->m_len;
	/* assume user leaves space for checksum */
	if ((len & 1) || len < MINPUPSIZ || len > MAXPUPSIZ) {
		error = EMSGSIZE;
		goto bad;
	}
	pup->pup_length = htons((u_short)len);
	dst = (struct sockaddr_pup *)&rp->rcb_faddr;
	bcopy((caddr_t)&dst->spup_net, (caddr_t)&pup->pup_dnet,
	    sizeof (struct pupport));
	if (rp->rcb_route.ro_rt == 0)
		ifp = if_ifonnetof(dst->spup_net);
	else {
		rp->rcb_route.ro_rt->rt_use++;
		ifp = rp->rcb_route.ro_rt->rt_ifp;
	}
	if (ifp == 0) {
		error = ENETUNREACH;
		goto bad;
	}
	if (rp->rcb_flags & RAW_LADDR) {
		register struct sockaddr_pup *src;

		src = (struct sockaddr_pup *)&rp->rcb_laddr;
		bcopy((caddr_t)&src->spup_net, (caddr_t)&pup->pup_snet,
		    sizeof (struct pupport));
	} else {
		pup->pup_snet = ifp->if_net;
		pup->pup_shost = ifp->if_host[0];
		/* socket is specified by user */
	}
	/*
	 * Fill in checksum unless user indicates none should be specified.
	 */
	pc = (u_short *)(mtod(last, caddr_t) + last->m_len - sizeof (short));
	if (*pc != PUP_NOCKSUM)
		*pc = htons((u_short)pup_cksum(m, len - sizeof (short)));
	return ((*ifp->if_output)(ifp, m, (struct sockaddr *)dst));
bad:
	m_freem(m);
	return (error);
}