Aren/NetBSD
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity
72f77e9fb3
NetBSD/sys/netccitt/hd_subr.c
thorpej d844a3ac41 First-draft if_detach() implementation, originally from Bill Studnemund, 
although this version has been changed somewhat:
- reference counting on ifaddrs isn't as complete as Bill's original
  work was.  This is hard to get right, and we should attack one
  protocol at a time.
- This doesn't do reference counting or dynamic allocation of ifnets yet.
- This version introduces a new PRU -- PRU_PURGEADDR, which is used to
  purge an ifaddr from a protocol.  The old method Bill used didn't work
  on all protocols, and it only worked on some because it was Very Lucky.

This mostly works ... i.e. works for my USB Ethernet, except for a dangling
ifaddr reference left by the IPv6 code; have not yet tracked this down.
2000-02-01 22:52:04 +00:00

399 lines
9.2 KiB
C
Raw Blame History

/* $NetBSD: hd_subr.c,v 1.11 2000/02/01 22:52:07 thorpej 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/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;
{
register struct x25config *xcp = (struct x25config *) addr;
register struct hdcb *hdp;
register 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)
register struct hdcb *hdp;
{
register struct mbuf *m;
register 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)
register struct hdcb *hdp;
struct Hdlc_frame *frame;
{
register int frametype = ILLEGAL;
register struct Hdlc_iframe *iframe = (struct Hdlc_iframe *) frame;
register struct Hdlc_sframe *sframe = (struct Hdlc_sframe *) frame;
register 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)
register struct hdcb *hdp;
register int frametype, pf;
{
register struct mbuf *buf;
struct Hdlc_frame *frame;
register struct Hdlc_sframe *sframe;
register 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_act = 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;
{
register struct mbuf *m;
m = q->head;
if (m) {
if ((q->head = m->m_act) == NULL)
q->tail = NULL;
m->m_act = 0;
}
return (m);
}
void
hd_append(q, m)
register struct hdtxq *q;
register struct mbuf *m;
{
m->m_act = NULL;
if (q->tail == NULL)
q->head = m;
else
q->tail->m_act = m;
q->tail = m;
}
void
hd_flush(ifp)
struct ifnet *ifp;
{
register struct mbuf *m;
register int s;
while (1) {
s = splimp();
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
Reference in New Issue View Git Blame Copy Permalink