xref: /csrg-svn/sys/netinet/udp_usrreq.c (revision 5050)

/*	udp_usrreq.c	4.8	81/11/23	*/

#include "../h/param.h"
#include "../h/dir.h"
#include "../h/user.h"
#include "../h/mbuf.h"
#define	PRUREQUESTS
#include "../h/protosw.h"
#include "../h/socket.h"
#include "../h/socketvar.h"
#include "../net/inet.h"
#include "../net/inet_pcb.h"
#include "../net/inet_systm.h"
#include "../net/ip.h"
#include "../net/ip_var.h"
#include "../net/udp.h"
#include "../net/udp_var.h"

/*
 * UDP protocol implementation.
 * Per RFC 768, August, 1980.
 */
udp_init()
{

	udb.inp_next = udb.inp_prev = &udb;
}

int	udpcksum;
struct	sockaddr_in udp_in = { AF_INET };

udp_input(m0)
	struct mbuf *m0;
{
	register struct udpiphdr *ui;
	register struct inpcb *inp;
	register struct mbuf *m;
	int len, ulen;

	/*
	 * Get ip and udp header together in first mbuf.
	 */
	printf("udp_input: ");
	m = m0;
	if (m->m_len < sizeof (struct udpiphdr) &&
	    m_pullup(m, sizeof (struct udpiphdr)) == 0) {
		udpstat.udps_hdrops++;
		printf("hdrop m_len %d\n", m->m_len);
		goto bad;
	}
	ui = mtod(m, struct udpiphdr *);
	if (ui->ui_len > sizeof (struct ip))
		ip_stripoptions((struct ip *)ui, (char *)0);

	/*
	 * Make mbuf data length reflect udp length.
	 * If not enough data to reflect udp length, drop.
	 */
	ulen = ntohs((u_short)ui->ui_ulen);
	len = sizeof (struct udpiphdr) + ulen;
	printf("ulen %d, len %d\n", ulen, len);
	if (((struct ip *)ui)->ip_len != len) {
		if (len > ((struct ip *)ui)->ip_len) {
			printf("udp badlen\n");
			udpstat.udps_badlen++;
			goto bad;
		}
		m_adj(m, ((struct ip *)ui)->ip_len - len);
		/* (struct ip *)ui->ip_len = len; */
	}

	/*
	 * Checksum extended udp header and data.
	 */
	if (udpcksum) {
		ui->ui_next = ui->ui_prev = 0;
		ui->ui_x1 = 0;
		ui->ui_len = htons((u_short)(sizeof (struct udpiphdr) + ulen));
		if ((ui->ui_sum = inet_cksum(m, len)) != 0xffff) {
			udpstat.udps_badsum++;
			printf("udp cksum %x\n", ui->ui_sum);
			m_freem(m);
			return;
		}
	}

	/*
	 * Convert addresses and ports to host format.
	 * Locate pcb for datagram.
	 */
	printf("src %x dst %x sport %x dport %x\n",
	    ui->ui_src.s_addr, ui->ui_dst.s_addr, ui->ui_sport, ui->ui_dport);
	inp = in_pcblookup(&udb,
	    ui->ui_src, ui->ui_sport, ui->ui_dst, ui->ui_dport);
	if (inp == 0) {
		printf("pcb not found\n");
		goto bad;
	}

	/*
	 * Construct sockaddr format source address.
	 * Stuff source address and datagram in user buffer.
	 */
	udp_in.sin_port = ui->ui_sport;
	udp_in.sin_addr = ui->ui_src;
	m->m_len -= sizeof (struct udpiphdr);
	m->m_off += sizeof (struct udpiphdr);
	if (sbappendaddr(&inp->inp_socket->so_rcv, (struct sockaddr *)&udp_in, m) == 0)
		goto bad;
	sorwakeup(inp->inp_socket);
	return;
bad:
	m_freem(m);
}

udp_ctlinput(m)
	struct mbuf *m;
{

	printf("udp_ctlinput\n");
	m_freem(m);
}

/*ARGSUSED*/
udp_output(inp, m0)
	struct inpcb *inp;
	struct mbuf *m0;
{
	register struct mbuf *m;
	register struct udpiphdr *ui;
	register int len = 0;

	/*
	 * Calculate data length and get a mbuf
	 * for udp and ip headers.
	 */
	for (m = m0; m; m = m->m_next)
		len += m->m_len;
	printf("udp_output len %d: ", len);
	m = m_get(0);
	if (m == 0) {
		printf("no mbufs\n");
		goto bad;
	}

	/*
	 * Fill in mbuf with extended udp header
	 * and addresses and length put into network format.
	 */
	m->m_off = MMAXOFF - sizeof (struct udpiphdr);
	m->m_len = sizeof (struct udpiphdr);
	m->m_next = m0;
	ui = mtod(m, struct udpiphdr *);
	ui->ui_next = ui->ui_prev = 0;
	ui->ui_x1 = 0;
	ui->ui_pr = IPPROTO_UDP;
	ui->ui_len = sizeof (struct udpiphdr) + len;
	ui->ui_src = inp->inp_laddr;
	ui->ui_dst = inp->inp_faddr;
	ui->ui_sport = inp->inp_lport;
	ui->ui_dport = inp->inp_fport;
	ui->ui_ulen = htons((u_short)len);
	printf("src %x dst %x sport %x dport %x",
	    ui->ui_src.s_addr, ui->ui_dst.s_addr, ui->ui_sport, ui->ui_dport);

	/*
	 * Stuff checksum and output datagram.
	 */
	ui->ui_sum = 0;
	ui->ui_sum = inet_cksum(m, sizeof (struct udpiphdr) + len);
	printf(" cksum %x\n", ui->ui_sum);
	((struct ip *)ui)->ip_len = sizeof (struct udpiphdr) + len;
	((struct ip *)ui)->ip_ttl = MAXTTL;
	ip_output(m);
	return;
bad:
	m_freem(m);
}

/*ARGSUSED*/
udp_usrreq(so, req, m, addr)
	struct socket *so;
	int req;
	struct mbuf *m;
	caddr_t addr;
{
	struct inpcb *inp = sotoinpcb(so);
	int error;

	printf("udp_usrreq %x %s\n", inp, prurequests[req]);
	if (inp == 0 && req != PRU_ATTACH) {
		printf("inp == 0 not on ATTACH\n");
		return (EINVAL);
	}
	switch (req) {

	case PRU_ATTACH:
		if (inp != 0)
			return (EINVAL);
		error = in_pcballoc(so, &udb, 2048, 2048, (struct sockaddr_in *)addr);
		if (error) {
			printf("in_pcballoc failed %d\n", error);
			return (error);
		}
		break;

	case PRU_DETACH:
		if (inp == 0)
			return (ENOTCONN);
		in_pcbfree(inp);
		break;

	case PRU_CONNECT:
		if (inp->inp_faddr.s_addr)
			return (EISCONN);
		error = in_pcbsetpeer(inp, (struct sockaddr_in *)addr);
		if (error) {
			printf("in_pcbsetpeer failed %d\n", error);
			return (error);
		}
		soisconnected(so);
		break;

	case PRU_ACCEPT:
		return (EOPNOTSUPP);

	case PRU_DISCONNECT:
		if (inp->inp_faddr.s_addr == 0)
			return (ENOTCONN);
		inp->inp_faddr.s_addr = 0;
		soisdisconnected(so);
		break;

	case PRU_SHUTDOWN:
		socantsendmore(so);
		break;

	case PRU_SEND:
		if (addr) {
			if (inp->inp_faddr.s_addr)
				return (EISCONN);
			error = in_pcbsetpeer(inp, (struct sockaddr_in *)addr);
			if (error) {
				printf("send setpeer failed %d\n", error);
				return (error);
			}
		} else {
			if (inp->inp_faddr.s_addr == 0)
				return (ENOTCONN);
		}
		printf("udp send m %x m_len %d * %c (%o)\n",
		    m, m->m_len, *(mtod(m, caddr_t)), *(mtod(m, caddr_t)));
		udp_output(inp, m);
		if (addr)
			inp->inp_faddr.s_addr = 0;
		break;

	case PRU_ABORT:
		in_pcbfree(inp);
		sofree(so);
		soisdisconnected(so);
		break;

	case PRU_CONTROL:
		return (EOPNOTSUPP);

	default:
		panic("udp_usrreq");
	}
	return (0);
}

/*ARGSUSED*/
udp_sense(m)
	struct mbuf *m;
{

	printf("udp_sense\n");
	return (EOPNOTSUPP);
}