NetBSD/sys/netccitt/hd_subr.c

/*	$NetBSD: hd_subr.c,v 1.15 2001/11/13 00:12:57 lukem Exp $	*/

/*
 * Copyright (c) 1984 University of British Columbia.
 * Copyright (c) 1990, 1993
 *	The Regents of the University of California.  All rights reserved.
 *
 * This code is derived from software contributed to Berkeley by
 * the Laboratory for Computation Vision and the Computer Science Department
 * of the University of British Columbia.
 *
 * 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.
 *
 *	@(#)hd_subr.c	8.1 (Berkeley) 6/10/93
 */

#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: hd_subr.c,v 1.15 2001/11/13 00:12:57 lukem Exp $");

#include <sys/param.h>
#include <sys/systm.h>
#include <sys/mbuf.h>
#include <sys/domain.h>
#include <sys/socket.h>
#include <sys/socketvar.h>
#include <sys/protosw.h>
#include <sys/errno.h>
#include <sys/time.h>
#include <sys/kernel.h>

#include <net/if.h>

#include <netccitt/hdlc.h>
#include <netccitt/hd_var.h>
#include <netccitt/x25.h>
#include <netccitt/pk_var.h>
#include <netccitt/pk_extern.h>

void
hd_init()
{

	hdintrq.ifq_maxlen = IFQ_MAXLEN;
}

void *
hd_ctlinput(prc, addr, ext)
	int             prc;
	struct sockaddr *addr;
	void           *ext;
{
	struct x25config *xcp = (struct x25config *) addr;
	struct hdcb *hdp;
	struct ifaddr *ifa;
	struct ifnet   *ifp;

	if (addr->sa_family != AF_CCITT)
		return (void *) (EAFNOSUPPORT);
	if (xcp->xc_lptype != HDLCPROTO_LAPB)
		return (void *) (EPROTONOSUPPORT);
	ifa = ifa_ifwithaddr(addr);
	if (ifa == 0 || ifa->ifa_addr->sa_family != AF_CCITT ||
	    (ifp = ifa->ifa_ifp) == 0)
		panic("hd_ctlinput");
	for (hdp = hdcbhead; hdp; hdp = hdp->hd_next)
		if (hdp->hd_ifp == ifp)
			break;

	if (hdp == 0) {		/* new interface */

		/* an hdcb is now too big to fit in an mbuf */
		MALLOC(hdp, struct hdcb *, sizeof(*hdp), M_PCB, M_DONTWAIT);
		if (hdp == 0)
			return (void *) (ENOBUFS);
		bzero((caddr_t) hdp, sizeof(*hdp));
		hdp->hd_pkp =
			(caddr_t) pk_newlink((struct x25_ifaddr *) ifa,
					     (caddr_t) hdp);
		((struct x25_ifaddr *) ifa)->ia_pkcb =
			(struct pkcb *) hdp->hd_pkp;
		if (hdp->hd_pkp == 0) {
			free(hdp, M_PCB);
			return (void *) (ENOBUFS);
		}
		hdp->hd_ifp = ifp;
		IFAREF(ifa);
		hdp->hd_ifa = ifa;
		hdp->hd_xcp = xcp;
		hdp->hd_state = INIT;
		hdp->hd_output = hd_ifoutput;
		hdp->hd_next = hdcbhead;
		hdcbhead = hdp;
	} else if (hdp->hd_pkp == 0) {	/* interface got reconfigured */
		hdp->hd_pkp =
			(caddr_t) pk_newlink((struct x25_ifaddr *) ifa,
					     (caddr_t) hdp);
		((struct x25_ifaddr *) ifa)->ia_pkcb =
			(struct pkcb *) hdp->hd_pkp;
		if (hdp->hd_pkp == 0) {
			free(hdp, M_PCB);
			return (void *) (ENOBUFS);
		}
	}
	switch (prc) {
	case PRC_IFUP:
		if (xcp->xc_lwsize == 0 ||
		    xcp->xc_lwsize > MAX_WINDOW_SIZE)
			xcp->xc_lwsize = MAX_WINDOW_SIZE;
		if (hdp->hd_state == INIT)
			SET_TIMER(hdp);
		break;

	case PRC_IFDOWN:
		if (hdp->hd_state == ABM)
			hd_message(hdp, "Operator shutdown: link closed");
		(void) pk_ctlinput(PRC_LINKDOWN,
				   (struct sockaddr *) hdp->hd_pkp, NULL);

		/* fall thru to ... */

	case PRC_DISCONNECT_REQUEST:
		/* drop reference to pkcb --- it's dead meat */
		hdp->hd_pkp = (caddr_t) 0;
		((struct x25_ifaddr *) ifa)->ia_pkcb = (struct pkcb *) 0;

		hd_writeinternal(hdp, DISC, POLLON);
		hdp->hd_state = DISC_SENT;
		SET_TIMER(hdp);
	}
	return (void *) (0);
}

void
hd_initvars(hdp)
	struct hdcb *hdp;
{
	struct mbuf *m;
	int    i;

	/* Clear Transmit queue. */
	while ((m = hd_remove(&hdp->hd_txq)) != NULL)
		m_freem(m);

	/* Clear Retransmit queue. */
	i = hdp->hd_lastrxnr;
	while (i != hdp->hd_retxqi) {
		m_freem(hdp->hd_retxq[i]);
		i = (i + 1) % MODULUS;
	}
	hdp->hd_retxqi = 0;

	hdp->hd_vs = hdp->hd_vr = 0;
	hdp->hd_lasttxnr = hdp->hd_lastrxnr = 0;
	hdp->hd_rrtimer = 0;
	KILL_TIMER(hdp);
	hdp->hd_retxcnt = 0;
	hdp->hd_condition = 0;
}

int
hd_decode(hdp, frame)
	struct hdcb *hdp;
	struct Hdlc_frame *frame;
{
	int    frametype = ILLEGAL;
	struct Hdlc_iframe *iframe = (struct Hdlc_iframe *) frame;
	struct Hdlc_sframe *sframe = (struct Hdlc_sframe *) frame;
	struct Hdlc_uframe *uframe = (struct Hdlc_uframe *) frame;

	if (iframe->hdlc_0 == 0) {
		frametype = IFRAME;
		hdp->hd_iframes_in++;
	} else if (sframe->hdlc_01 == 1) {
		/* Supervisory format. */
		switch (sframe->s2) {
		case 0:
			frametype = RR;
			hdp->hd_rrs_in++;
			break;

		case 1:
			frametype = RNR;
			hdp->hd_rnrs_in++;
			break;

		case 2:
			frametype = REJ;
			hdp->hd_rejs_in++;
		}
	} else if (uframe->hdlc_11 == 3) {
		/* Unnumbered format. */
		switch (uframe->m3) {
		case 0:
			frametype = DM;
			break;

		case 1:
			frametype = SABM;
			break;

		case 2:
			frametype = DISC;
			break;

		case 3:
			frametype = UA;
			break;

		case 4:
			frametype = FRMR;
			hdp->hd_frmrs_in++;
		}
	}
	return (frametype);
}

/*
 * This routine is called when the HDLC layer internally  generates a command
 * or  response  for  the remote machine ( eg. RR, UA etc. ). Only
 * supervisory or unnumbered frames are processed.
 */

void
hd_writeinternal(hdp, frametype, pf)
	struct hdcb *hdp;
	int    frametype, pf;
{
	struct mbuf *buf;
	struct Hdlc_frame *frame;
	struct Hdlc_sframe *sframe;
	struct Hdlc_uframe *uframe;

	MGETHDR(buf, M_DONTWAIT, MT_HEADER);
	if (buf == 0)
		return;
	frame = mtod(buf, struct Hdlc_frame *);
	sframe = mtod(buf, struct Hdlc_sframe *);
	uframe = mtod(buf, struct Hdlc_uframe *);

	/* Assume a response - address structure for DTE */
	frame->address = ADDRESS_A;
	buf->m_len = 2;
	buf->m_nextpkt = buf->m_next = NULL;

	switch (frametype) {
	case RR:
		frame->control = RR_CONTROL;
		hdp->hd_rrs_out++;
		break;

	case RNR:
		frame->control = RNR_CONTROL;
		hdp->hd_rnrs_out++;
		break;

	case REJ:
		frame->control = REJ_CONTROL;
		hdp->hd_rejs_out++;
		break;

	case SABM:
		frame->control = SABM_CONTROL;
		frame->address = ADDRESS_B;
		break;

	case DISC:
		if ((hdp->hd_ifp->if_flags & IFF_UP) == 0) {
			hdp->hd_state = DISCONNECTED;
			(void) m_freem(buf);
			hd_flush(hdp->hd_ifp);
			return;
		}
		frame->control = DISC_CONTROL;
		frame->address = ADDRESS_B;
		break;

	case DM:
		frame->control = DM_CONTROL;
		break;

	case UA:
		frame->control = UA_CONTROL;
		break;

	case FRMR:
		frame->control = FRMR_CONTROL;
		bcopy((caddr_t) & hd_frmr, (caddr_t) frame->info, 3);
		buf->m_len = 5;
		hdp->hd_frmrs_out++;

	}

	if (sframe->hdlc_01 == 1) {
		/* Supervisory format - RR, REJ, or RNR. */
		sframe->nr = hdp->hd_vr;
		sframe->pf = pf;
		hdp->hd_lasttxnr = hdp->hd_vr;
		hdp->hd_rrtimer = 0;
	} else
		uframe->pf = pf;

	hd_trace(hdp, TX, buf);
	buf->m_pkthdr.len = buf->m_len;
	(*hdp->hd_output) (buf, hdp, NULL);
}

struct mbuf *
hd_remove(q)
	struct hdtxq   *q;
{
	struct mbuf *m;

	m = q->head;
	if (m) {
		if ((q->head = m->m_nextpkt) == NULL)
			q->tail = NULL;
		m->m_nextpkt = 0;
	}
	return (m);
}

void
hd_append(q, m)
	struct hdtxq *q;
	struct mbuf *m;
{

	m->m_nextpkt = NULL;
	if (q->tail == NULL)
		q->head = m;
	else
		q->tail->m_nextpkt = m;
	q->tail = m;
}

void
hd_flush(ifp)
	struct ifnet   *ifp;
{
	struct mbuf *m;
	int    s;

	while (1) {
		s = splnet();
		IF_DEQUEUE(&ifp->if_snd, m);
		splx(s);
		if (m == 0)
			break;
		m_freem(m);
	}
}

void
hd_message(hdp, msg)
	struct hdcb    *hdp;
	char           *msg;
{
	if (hdcbhead->hd_next)
		printf("HDLC(%s): %s\n", format_ntn(hdp->hd_xcp), msg);
	else
		printf("HDLC: %s\n", msg);
}

#ifdef HDLCDEBUG
void
hd_status(hdp)
	struct hdcb    *hdp;
{
	printf("HDLC STATUS:\n V(S)=%d, V(R)=%d, retxqi=%d,\n",
	    hdp->hd_vs, hdp->hd_vr, hdp->hd_retxqi);

	printf("Last_rx_nr=%d, Last_tx_nr=%d,\n Condition=%d, Xx=%d\n",
	    hdp->hd_lastrxnr, hdp->hd_lasttxnr, hdp->hd_condition, hdp->hd_xx);
}
#endif