d/freebsd-skq
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity
b89bc9e62b
freebsd-skq/sys/i4b/driver/i4b_ipr.c
Warner Losh a163d034fa Back out M_* changes, per decision of the TRB. 
Approved by: trb
2003-02-19 05:47:46 +00:00

1024 lines
26 KiB
C
Raw Blame History

/*
* Copyright (c) 1997, 2002 Hellmuth Michaelis. 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.
*
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR 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 AUTHOR 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.
*
*---------------------------------------------------------------------------
*
* i4b_ipr.c - isdn4bsd IP over raw HDLC ISDN network driver
* ---------------------------------------------------------
*
* $FreeBSD$
*
* last edit-date: [Sun Mar 17 09:32:58 2002]
*
*---------------------------------------------------------------------------*
*
* statistics counter usage (interface lifetime):
* ----------------------------------------------
* sc->sc_if.if_ipackets # of received packets
* sc->sc_if.if_ierrors # of error packets not going to upper layers
* sc->sc_if.if_opackets # of transmitted packets
* sc->sc_if.if_oerrors # of error packets not being transmitted
* sc->sc_if.if_collisions # of invalid ip packets after VJ decompression
* sc->sc_if.if_ibytes # of bytes coming in from the line (before VJ)
* sc->sc_if.if_obytes # of bytes going out to the line (after VJ)
* sc->sc_if.if_imcasts (currently unused)
* sc->sc_if.if_omcasts # of frames sent out of the fastqueue
* sc->sc_if.if_iqdrops # of frames dropped on input because queue full
* sc->sc_if.if_noproto # of frames dropped on output because !AF_INET
*
* statistics counter usage (connection lifetime):
* -----------------------------------------------
* sc->sc_iinb # of ISDN incoming bytes from HSCX
* sc->sc_ioutb # of ISDN outgoing bytes from HSCX
* sc->sc_inb # of incoming bytes after decompression
* sc->sc_outb # of outgoing bytes before compression
*
*---------------------------------------------------------------------------*/
#include "i4bipr.h"
#include "opt_i4b.h"
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/mbuf.h>
#include <sys/socket.h>
#include <sys/errno.h>
#include <sys/ioccom.h>
#include <sys/sockio.h>
#include <sys/kernel.h>
#include <net/if.h>
#include <net/if_types.h>
#include <net/netisr.h>
#include <netinet/in.h>
#include <netinet/in_systm.h>
#include <netinet/in_var.h>
#include <netinet/ip.h>
#ifdef IPR_VJ
#include <sys/malloc.h>
#include <net/slcompress.h>
#define IPR_COMPRESS IFF_LINK0 /* compress TCP traffic */
#define IPR_AUTOCOMP IFF_LINK1 /* auto-enable TCP compression */
/*---------------------------------------------------------------------------
* NOTICE: using NO separate buffer relies on the assumption, that the HSCX
* IRQ handler _always_ allocates a single, continuous mbuf cluster large
* enough to hold the maximum MTU size if the ipr interface !
*
* CAUTION: i have re-defined IPR_VJ_USEBUFFER because it makes problems
* with 2 i4b's back to back running cvs over ssh, cvs simply
* aborts because it gets bad data. Everything else (telnet/ftp?etc)
* functions fine.
*---------------------------------------------------------------------------*/
#define IPR_VJ_USEBUFFER /* define to use an allocated separate buffer*/
/* undef to uncompress in the mbuf itself */
#endif /* IPR_VJ */
#include <sys/time.h>
#include <net/bpf.h>
#include <machine/i4b_ioctl.h>
#include <machine/i4b_debug.h>
#include <i4b/include/i4b_global.h>
#include <i4b/include/i4b_l3l4.h>
#include <i4b/layer4/i4b_l4.h>
#define I4BIPRMTU 1500 /* regular MTU */
#define I4BIPRMAXMTU 2000 /* max MTU */
#define I4BIPRMINMTU 500 /* min MTU */
#define I4BIPRMAXQLEN 50 /* max queue length */
#define I4BIPRACCT 1 /* enable accounting messages */
#define I4BIPRACCTINTVL 2 /* accounting msg interval in secs */
#define I4BIPRADJFRXP 1 /* adjust 1st rxd packet */
/* initialized by L4 */
static drvr_link_t ipr_drvr_linktab[NI4BIPR];
static isdn_link_t *isdn_linktab[NI4BIPR];
struct ipr_softc {
struct ifnet sc_if; /* network-visible interface */
int sc_state; /* state of the interface */
call_desc_t *sc_cdp; /* ptr to call descriptor */
int sc_updown; /* soft state of interface */
struct ifqueue sc_fastq; /* interactive traffic */
int sc_dialresp; /* dialresponse */
int sc_lastdialresp;/* last dialresponse */
struct callout_handle sc_callout;
#if I4BIPRACCT
int sc_iinb; /* isdn driver # of inbytes */
int sc_ioutb; /* isdn driver # of outbytes */
int sc_inb; /* # of bytes rx'd */
int sc_outb; /* # of bytes tx'd */
int sc_linb; /* last # of bytes rx'd */
int sc_loutb; /* last # of bytes tx'd */
int sc_fn; /* flag, first null acct */
#endif
#ifdef I4BIPRADJFRXP
int sc_first_pkt; /* flag, first rxd packet */
#endif
#if IPR_LOG
int sc_log_first; /* log first n packets */
#endif
#ifdef IPR_VJ
struct slcompress sc_compr; /* tcp compression data */
#ifdef IPR_VJ_USEBUFFER
u_char *sc_cbuf; /* tcp decompression buffer */
#endif
#endif
} ipr_softc[NI4BIPR];
enum ipr_states {
ST_IDLE, /* initialized, ready, idle */
ST_DIALING, /* dialling out to remote */
ST_CONNECTED_W, /* connected to remote */
ST_CONNECTED_A, /* connected to remote */
};
static void i4biprattach(void *);
PSEUDO_SET(i4biprattach, i4b_ipr);
static int i4biprioctl(struct ifnet *ifp, u_long cmd, caddr_t data);
static void iprwatchdog(struct ifnet *ifp);
static void ipr_init_linktab(int unit);
static void ipr_tx_queue_empty(int unit);
static int i4biproutput(struct ifnet *ifp, struct mbuf *m, struct sockaddr *dst, struct rtentry *rtp);
static void iprclearqueues(struct ipr_softc *sc);
/*===========================================================================*
* DEVICE DRIVER ROUTINES
*===========================================================================*/
/*---------------------------------------------------------------------------*
* interface attach routine at kernel boot time
*---------------------------------------------------------------------------*/
static void
i4biprattach(void *dummy)
{
struct ipr_softc *sc = ipr_softc;
int i;
#ifdef IPR_VJ
printf("i4bipr: %d IP over raw HDLC ISDN device(s) attached (VJ header compression)\n", NI4BIPR);
#else
printf("i4bipr: %d IP over raw HDLC ISDN device(s) attached\n", NI4BIPR);
#endif
for(i=0; i < NI4BIPR; sc++, i++)
{
ipr_init_linktab(i);
NDBGL4(L4_DIALST, "setting dial state to ST_IDLE");
sc->sc_state = ST_IDLE;
sc->sc_if.if_name = "ipr";
sc->sc_if.if_unit = i;
#ifdef IPR_VJ
sc->sc_if.if_flags = IFF_POINTOPOINT | IFF_SIMPLEX | IPR_AUTOCOMP;
#else
sc->sc_if.if_flags = IFF_POINTOPOINT | IFF_SIMPLEX;
#endif
sc->sc_if.if_mtu = I4BIPRMTU;
sc->sc_if.if_type = IFT_ISDNBASIC;
sc->sc_if.if_ioctl = i4biprioctl;
sc->sc_if.if_output = i4biproutput;
sc->sc_if.if_snd.ifq_maxlen = I4BIPRMAXQLEN;
sc->sc_fastq.ifq_maxlen = I4BIPRMAXQLEN;
if(!mtx_initialized(&sc->sc_fastq.ifq_mtx))
mtx_init(&sc->sc_fastq.ifq_mtx, "i4b_ipr_fastq", NULL, MTX_DEF);
sc->sc_if.if_ipackets = 0;
sc->sc_if.if_ierrors = 0;
sc->sc_if.if_opackets = 0;
sc->sc_if.if_oerrors = 0;
sc->sc_if.if_collisions = 0;
sc->sc_if.if_ibytes = 0;
sc->sc_if.if_obytes = 0;
sc->sc_if.if_imcasts = 0;
sc->sc_if.if_omcasts = 0;
sc->sc_if.if_iqdrops = 0;
sc->sc_if.if_noproto = 0;
#if I4BIPRACCT
sc->sc_if.if_timer = 0;
sc->sc_if.if_watchdog = iprwatchdog;
sc->sc_iinb = 0;
sc->sc_ioutb = 0;
sc->sc_inb = 0;
sc->sc_outb = 0;
sc->sc_linb = 0;
sc->sc_loutb = 0;
sc->sc_fn = 1;
#endif
#if IPR_LOG
sc->sc_log_first = IPR_LOG;
#endif
#ifdef IPR_VJ
sl_compress_init(&sc->sc_compr, -1);
#ifdef IPR_VJ_USEBUFFER
if(!((sc->sc_cbuf =
(u_char *)malloc(I4BIPRMAXMTU+128, M_DEVBUF, M_WAITOK))))
{
panic("if_ipr.c, ipr_attach: VJ malloc failed");
}
#endif
#endif
sc->sc_updown = SOFT_ENA; /* soft enabled */
sc->sc_dialresp = DSTAT_NONE; /* no response */
sc->sc_lastdialresp = DSTAT_NONE;
if_attach(&sc->sc_if);
bpfattach(&sc->sc_if, DLT_NULL, sizeof(u_int));
}
}
/*---------------------------------------------------------------------------*
* output a packet to the ISDN B-channel
*---------------------------------------------------------------------------*/
static int
i4biproutput(struct ifnet *ifp, struct mbuf *m, struct sockaddr *dst,
struct rtentry *rtp)
{
struct ipr_softc *sc;
int unit;
int s;
struct ifqueue *ifq;
struct ip *ip;
s = SPLI4B();
unit = ifp->if_unit;
sc = &ipr_softc[unit];
/* check for IP */
if(dst->sa_family != AF_INET)
{
if_printf(ifp, "af%d not supported\n", dst->sa_family);
m_freem(m);
splx(s);
sc->sc_if.if_noproto++;
sc->sc_if.if_oerrors++;
return(EAFNOSUPPORT);
}
/* check interface state = UP */
if(!(ifp->if_flags & IFF_UP))
{
NDBGL4(L4_IPRDBG, "ipr%d: interface is DOWN!", unit);
m_freem(m);
splx(s);
sc->sc_if.if_oerrors++;
return(ENETDOWN);
}
/* dial if necessary */
if(sc->sc_state == ST_IDLE || sc->sc_state == ST_DIALING)
{
#ifdef NOTDEF
switch(sc->sc_dialresp)
{
case DSTAT_TFAIL: /* transient failure */
NDBGL4(L4_IPRDBG, "ipr%d: transient dial failure!", unit);
m_freem(m);
iprclearqueues(sc);
sc->sc_dialresp = DSTAT_NONE;
splx(s);
sc->sc_if.if_oerrors++;
return(ENETUNREACH);
break;
case DSTAT_PFAIL: /* permanent failure */
NDBGL4(L4_IPRDBG, "ipr%d: permanent dial failure!", unit);
m_freem(m);
iprclearqueues(sc);
sc->sc_dialresp = DSTAT_NONE;
splx(s);
sc->sc_if.if_oerrors++;
return(EHOSTUNREACH);
break;
case DSTAT_INONLY: /* no dialout allowed*/
NDBGL4(L4_IPRDBG, "ipr%d: dialout not allowed failure!", unit);
m_freem(m);
iprclearqueues(sc);
sc->sc_dialresp = DSTAT_NONE;
splx(s);
sc->sc_if.if_oerrors++;
return(EHOSTUNREACH);
break;
}
#endif
NDBGL4(L4_IPRDBG, "ipr%d: send dial request message!", unit);
NDBGL4(L4_DIALST, "ipr%d: setting dial state to ST_DIALING", unit);
i4b_l4_dialout(BDRV_IPR, unit);
sc->sc_state = ST_DIALING;
}
#if IPR_LOG
if(sc->sc_log_first > 0)
{
--(sc->sc_log_first);
i4b_l4_packet_ind(BDRV_IPR, unit, 1, m );
}
#endif
/* update access time */
microtime(&sc->sc_if.if_lastchange);
/*
* check, if type of service indicates interactive, i.e. telnet,
* traffic. in case it is interactive, put it into the fast queue,
* else (i.e. ftp traffic) put it into the "normal" queue
*/
ip = mtod(m, struct ip *); /* get ptr to ip header */
if(ip->ip_tos & IPTOS_LOWDELAY)
ifq = &sc->sc_fastq;
else
ifq = &sc->sc_if.if_snd;
/* check for space in choosen send queue */
if(! IF_HANDOFF(ifq, m, NULL))
{
NDBGL4(L4_IPRDBG, "ipr%d: send queue full!", unit);
splx(s);
sc->sc_if.if_oerrors++;
return(ENOBUFS);
}
NDBGL4(L4_IPRDBG, "ipr%d: add packet to send queue!", unit);
ipr_tx_queue_empty(unit);
splx(s);
return (0);
}
/*---------------------------------------------------------------------------*
* process ioctl
*---------------------------------------------------------------------------*/
static int
i4biprioctl(struct ifnet *ifp, u_long cmd, caddr_t data)
{
struct ipr_softc *sc = &ipr_softc[ifp->if_unit];
struct ifreq *ifr = (struct ifreq *)data;
struct ifaddr *ifa = (struct ifaddr *)data;
int s;
int error = 0;
s = SPLI4B();
switch (cmd)
{
case SIOCAIFADDR: /* add interface address */
case SIOCSIFADDR: /* set interface address */
case SIOCSIFDSTADDR: /* set interface destination address */
if(ifa->ifa_addr->sa_family != AF_INET)
error = EAFNOSUPPORT;
else
sc->sc_if.if_flags |= IFF_UP;
microtime(&sc->sc_if.if_lastchange);
break;
case SIOCSIFFLAGS: /* set interface flags */
if(!(ifr->ifr_flags & IFF_UP))
{
if(sc->sc_if.if_flags & IFF_RUNNING)
{
/* disconnect ISDN line */
i4b_l4_drvrdisc(BDRV_IPR, ifp->if_unit);
sc->sc_if.if_flags &= ~IFF_RUNNING;
}
sc->sc_state = ST_IDLE;
/* empty queues */
iprclearqueues(sc);
}
if(ifr->ifr_flags & IFF_DEBUG)
{
/* enable debug messages */
}
microtime(&sc->sc_if.if_lastchange);
break;
case SIOCSIFMTU: /* set interface MTU */
if(ifr->ifr_mtu > I4BIPRMAXMTU)
error = EINVAL;
else if(ifr->ifr_mtu < I4BIPRMINMTU)
error = EINVAL;
else
{
ifp->if_mtu = ifr->ifr_mtu;
microtime(&sc->sc_if.if_lastchange);
}
break;
#if 0
/* not needed for FreeBSD, done in sl_compress_init() (-hm) */
/* need to add an ioctl: set VJ max slot ID
* #define IPRIOCSMAXCID _IOW('I', XXX, int)
*/
#ifdef IPR_VJ
case IPRIOCSMAXCID:
{
struct thread *td = curthread; /* XXX */
if((error = suser(td)))
return (error);
sl_compress_setup(sc->sc_compr, *(int *)data);
}
break;
#endif
#endif /* #if 0 */
default:
error = EINVAL;
break;
}
splx(s);
return(error);
}
/*---------------------------------------------------------------------------*
* clear the interface's send queues
*---------------------------------------------------------------------------*/
static void
iprclearqueues(struct ipr_softc *sc)
{
int x;
x = splimp();
IF_DRAIN(&sc->sc_fastq);
IF_DRAIN(&sc->sc_if.if_snd);
splx(x);
}
#if I4BIPRACCT
/*---------------------------------------------------------------------------*
* watchdog routine
*---------------------------------------------------------------------------*/
static void
iprwatchdog(struct ifnet *ifp)
{
int unit = ifp->if_unit;
struct ipr_softc *sc = &ipr_softc[unit];
bchan_statistics_t bs;
/* get # of bytes in and out from the HSCX driver */
(*isdn_linktab[unit]->bch_stat)
(isdn_linktab[unit]->unit, isdn_linktab[unit]->channel, &bs);
sc->sc_ioutb += bs.outbytes;
sc->sc_iinb += bs.inbytes;
if((sc->sc_iinb != sc->sc_linb) || (sc->sc_ioutb != sc->sc_loutb) || sc->sc_fn)
{
int ri = (sc->sc_iinb - sc->sc_linb)/I4BIPRACCTINTVL;
int ro = (sc->sc_ioutb - sc->sc_loutb)/I4BIPRACCTINTVL;
if((sc->sc_iinb == sc->sc_linb) && (sc->sc_ioutb == sc->sc_loutb))
sc->sc_fn = 0;
else
sc->sc_fn = 1;
sc->sc_linb = sc->sc_iinb;
sc->sc_loutb = sc->sc_ioutb;
i4b_l4_accounting(BDRV_IPR, unit, ACCT_DURING,
sc->sc_ioutb, sc->sc_iinb, ro, ri, sc->sc_outb, sc->sc_inb);
}
sc->sc_if.if_timer = I4BIPRACCTINTVL;
}
#endif /* I4BIPRACCT */
/*===========================================================================*
* ISDN INTERFACE ROUTINES
*===========================================================================*/
/*---------------------------------------------------------------------------*
* start transmitting after connect
*---------------------------------------------------------------------------*/
static void
i4bipr_connect_startio(struct ipr_softc *sc)
{
int s = SPLI4B();
if(sc->sc_state == ST_CONNECTED_W)
{
sc->sc_state = ST_CONNECTED_A;
ipr_tx_queue_empty(sc->sc_if.if_unit);
}
splx(s);
}
/*---------------------------------------------------------------------------*
* this routine is called from L4 handler at connect time
*---------------------------------------------------------------------------*/
static void
ipr_connect(int unit, void *cdp)
{
struct ipr_softc *sc = &ipr_softc[unit];
int s;
sc->sc_cdp = (call_desc_t *)cdp;
s = SPLI4B();
NDBGL4(L4_DIALST, "ipr%d: setting dial state to ST_CONNECTED", unit);
sc->sc_if.if_flags |= IFF_RUNNING;
sc->sc_state = ST_CONNECTED_W;
sc->sc_dialresp = DSTAT_NONE;
sc->sc_lastdialresp = DSTAT_NONE;
#if I4BIPRACCT
sc->sc_iinb = 0;
sc->sc_ioutb = 0;
sc->sc_inb = 0;
sc->sc_outb = 0;
sc->sc_linb = 0;
sc->sc_loutb = 0;
sc->sc_if.if_timer = I4BIPRACCTINTVL;
#endif
#ifdef I4BIPRADJFRXP
sc->sc_first_pkt = 1;
#endif
/*
* Sometimes ISDN B-channels are switched thru asymmetic. This
* means that under such circumstances B-channel data (the first
* three packets of a TCP connection in my case) may get lost,
* causing a large delay until the connection is started.
* When the sending of the very first packet of a TCP connection
* is delayed for a to be empirically determined delay (close
* to a second in my case) those packets go thru and the TCP
* connection comes up "almost" immediately (-hm).
*/
if(sc->sc_cdp->isdntxdelay > 0)
{
int delay;
if (hz == 100) {
delay = sc->sc_cdp->isdntxdelay; /* avoid any rounding */
} else {
delay = sc->sc_cdp->isdntxdelay*hz;
delay /= 100;
}
START_TIMER(sc->sc_callout, (TIMEOUT_FUNC_T)i4bipr_connect_startio, (void *)sc, delay);
}
else
{
sc->sc_state = ST_CONNECTED_A;
ipr_tx_queue_empty(unit);
}
splx(s);
/* we don't need any negotiation - pass event back right now */
i4b_l4_negcomplete(sc->sc_cdp);
}
/*---------------------------------------------------------------------------*
* this routine is called from L4 handler at disconnect time
*---------------------------------------------------------------------------*/
static void
ipr_disconnect(int unit, void *cdp)
{
call_desc_t *cd = (call_desc_t *)cdp;
struct ipr_softc *sc = &ipr_softc[unit];
/* new stuff to check that the active channel is being closed */
if (cd != sc->sc_cdp)
{
NDBGL4(L4_IPRDBG, "ipr%d: channel %d not active",
cd->driver_unit, cd->channelid);
return;
}
#if I4BIPRACCT
sc->sc_if.if_timer = 0;
#endif
#if IPR_LOG
/* show next IPR_LOG packets again */
sc->sc_log_first = IPR_LOG;
#endif
i4b_l4_accounting(BDRV_IPR, cd->driver_unit, ACCT_FINAL,
sc->sc_ioutb, sc->sc_iinb, 0, 0, sc->sc_outb, sc->sc_inb);
sc->sc_cdp = (call_desc_t *)0;
NDBGL4(L4_DIALST, "setting dial state to ST_IDLE");
sc->sc_dialresp = DSTAT_NONE;
sc->sc_lastdialresp = DSTAT_NONE;
sc->sc_if.if_flags &= ~IFF_RUNNING;
sc->sc_state = ST_IDLE;
}
/*---------------------------------------------------------------------------*
* this routine is used to give a feedback from userland daemon
* in case of dial problems
*---------------------------------------------------------------------------*/
static void
ipr_dialresponse(int unit, int status, cause_t cause)
{
struct ipr_softc *sc = &ipr_softc[unit];
sc->sc_dialresp = status;
NDBGL4(L4_IPRDBG, "ipr%d: last=%d, this=%d",
unit, sc->sc_lastdialresp, sc->sc_dialresp);
if(status != DSTAT_NONE)
{
NDBGL4(L4_IPRDBG, "ipr%d: clearing queues", unit);
iprclearqueues(sc);
}
}
/*---------------------------------------------------------------------------*
* interface soft up/down
*---------------------------------------------------------------------------*/
static void
ipr_updown(int unit, int updown)
{
struct ipr_softc *sc = &ipr_softc[unit];
sc->sc_updown = updown;
}
/*---------------------------------------------------------------------------*
* this routine is called from the HSCX interrupt handler
* when a new frame (mbuf) has been received and was put on
* the rx queue. It is assumed that this routines runs at
* pri level splimp() ! Keep it short !
*---------------------------------------------------------------------------*/
static void
ipr_rx_data_rdy(int unit)
{
register struct ipr_softc *sc = &ipr_softc[unit];
register struct mbuf *m;
#ifdef IPR_VJ
#ifdef IPR_VJ_USEBUFFER
u_char *cp = sc->sc_cbuf;
#endif
int len, c;
#endif
if((m = *isdn_linktab[unit]->rx_mbuf) == NULL)
return;
m->m_pkthdr.rcvif = &sc->sc_if;
m->m_pkthdr.len = m->m_len;
microtime(&sc->sc_if.if_lastchange);
#ifdef I4BIPRADJFRXP
/*
* The very first packet after the B channel is switched thru
* has very often several bytes of random data prepended. This
* routine looks where the IP header starts and removes the
* the bad data.
*/
if(sc->sc_first_pkt)
{
unsigned char *mp = m->m_data;
int i;
sc->sc_first_pkt = 0;
for(i = 0; i < m->m_len; i++, mp++)
{
if( ((*mp & 0xf0) == 0x40) &&
((*mp & 0x0f) >= 0x05) )
{
m->m_data = mp;
m->m_pkthdr.len -= i;
break;
}
}
}
#endif
sc->sc_if.if_ipackets++;
sc->sc_if.if_ibytes += m->m_pkthdr.len;
#ifdef IPR_VJ
if((c = (*(mtod(m, u_char *)) & 0xf0)) != (IPVERSION << 4))
{
/* copy data to buffer */
len = m->m_len;
#ifdef IPR_VJ_USEBUFFER
/* XXX */ m_copydata(m, 0, len, cp);
#endif
if(c & 0x80)
{
c = TYPE_COMPRESSED_TCP;
}
else if(c == TYPE_UNCOMPRESSED_TCP)
{
#ifdef IPR_VJ_USEBUFFER
*cp &= 0x4f; /* XXX */
#else
*(mtod(m, u_char *)) &= 0x4f;
#endif
}
/*
* We've got something that's not an IP packet.
* If compression is enabled, try to decompress it.
* Otherwise, if `auto-enable' compression is on and
* it's a reasonable packet, decompress it and then
* enable compression. Otherwise, drop it.
*/
if(sc->sc_if.if_flags & IPR_COMPRESS)
{
#ifdef IPR_VJ_USEBUFFER
len = sl_uncompress_tcp(&cp,len,(u_int)c,&sc->sc_compr);
#else
len = sl_uncompress_tcp((u_char **)&m->m_data, len,
(u_int)c, &sc->sc_compr);
#endif
if(len <= 0)
{
#ifdef DEBUG_IPR_VJ
printf("i4b_ipr, ipr_rx_data_rdy: len <= 0 IPR_COMPRESS!\n");
#endif
goto error;
}
}
else if((sc->sc_if.if_flags & IPR_AUTOCOMP) &&
(c == TYPE_UNCOMPRESSED_TCP) && (len >= 40))
{
#ifdef IPR_VJ_USEBUFFER
len = sl_uncompress_tcp(&cp,len,(u_int)c,&sc->sc_compr);
#else
len = sl_uncompress_tcp((u_char **)&m->m_data, len,
(u_int)c, &sc->sc_compr);
#endif
if(len <= 0)
{
#ifdef DEBUG_IPR_VJ
printf("i4b_ipr, ipr_rx_data_rdy: len <= 0 IPR_AUTOCOMP!\n");
#endif
goto error;
}
sc->sc_if.if_flags |= IPR_COMPRESS;
}
else
{
#ifdef DEBUG_IPR_VJ
printf("i4b_ipr, ipr_input: invalid ip packet!\n");
#endif
error:
sc->sc_if.if_ierrors++;
sc->sc_if.if_collisions++;
m_freem(m);
return;
}
#ifdef IPR_VJ_USEBUFFER
/* XXX */ m_copyback(m, 0, len, cp);
#else
m->m_len = m->m_pkthdr.len = len;
#endif
}
#endif
#if I4BIPRACCT
/* NB. do the accounting after decompression! */
sc->sc_inb += m->m_pkthdr.len;
#endif
#if IPR_LOG
if(sc->sc_log_first > 0)
{
--(sc->sc_log_first);
i4b_l4_packet_ind(BDRV_IPR, unit, 0, m );
}
#endif
if(sc->sc_if.if_bpf)
{
/* prepend the address family as a four byte field */
struct mbuf mm;
u_int af = AF_INET;
mm.m_next = m;
mm.m_len = 4;
mm.m_data = (char *)&af;
BPF_MTAP(&sc->sc_if, &mm);
}
if(! IF_HANDOFF(&ipintrq, m, NULL))
{
NDBGL4(L4_IPRDBG, "ipr%d: ipintrq full!", unit);
sc->sc_if.if_ierrors++;
sc->sc_if.if_iqdrops++;
}
else
{
schednetisr(NETISR_IP);
}
}
/*---------------------------------------------------------------------------*
* this routine is called from the HSCX interrupt handler
* when the last frame has been sent out and there is no
* further frame (mbuf) in the tx queue.
*---------------------------------------------------------------------------*/
static void
ipr_tx_queue_empty(int unit)
{
register struct ipr_softc *sc = &ipr_softc[unit];
register struct mbuf *m;
#ifdef IPR_VJ
struct ip *ip;
#endif
int x = 0;
if(sc->sc_state != ST_CONNECTED_A)
return;
for(;;)
{
IF_DEQUEUE(&sc->sc_fastq, m);
if(m)
{
sc->sc_if.if_omcasts++;
}
else
{
IF_DEQUEUE(&sc->sc_if.if_snd, m);
if(m == NULL)
break;
}
microtime(&sc->sc_if.if_lastchange);
if(sc->sc_if.if_bpf)
{
/* prepend the address family as a four byte field */
struct mbuf mm;
u_int af = AF_INET;
mm.m_next = m;
mm.m_len = 4;
mm.m_data = (char *)&af;
BPF_MTAP(&sc->sc_if, &mm);
}
#if I4BIPRACCT
sc->sc_outb += m->m_pkthdr.len; /* size before compression */
#endif
#ifdef IPR_VJ
if((ip = mtod(m, struct ip *))->ip_p == IPPROTO_TCP)
{
if(sc->sc_if.if_flags & IPR_COMPRESS)
{
*mtod(m, u_char *) |= sl_compress_tcp(m, ip,
&sc->sc_compr, 1);
}
}
#endif
x = 1;
IF_LOCK(isdn_linktab[unit]->tx_queue);
if(_IF_QFULL(isdn_linktab[unit]->tx_queue))
{
NDBGL4(L4_IPRDBG, "ipr%d: tx queue full!", unit);
m_freem(m);
}
else
{
sc->sc_if.if_obytes += m->m_pkthdr.len;
sc->sc_if.if_opackets++;
_IF_ENQUEUE(isdn_linktab[unit]->tx_queue, m);
}
IF_UNLOCK(isdn_linktab[unit]->tx_queue);
}
if(x)
(*isdn_linktab[unit]->bch_tx_start)(isdn_linktab[unit]->unit, isdn_linktab[unit]->channel);
}
/*---------------------------------------------------------------------------*
* this routine is called from the HSCX interrupt handler
* each time a packet is received or transmitted. It should
* be used to implement an activity timeout mechanism.
*---------------------------------------------------------------------------*/
static void
ipr_activity(int unit, int rxtx)
{
ipr_softc[unit].sc_cdp->last_active_time = SECOND;
}
/*---------------------------------------------------------------------------*
* return this drivers linktab address
*---------------------------------------------------------------------------*/
drvr_link_t *
ipr_ret_linktab(int unit)
{
return(&ipr_drvr_linktab[unit]);
}
/*---------------------------------------------------------------------------*
* setup the isdn_linktab for this driver
*---------------------------------------------------------------------------*/
void
ipr_set_linktab(int unit, isdn_link_t *ilt)
{
isdn_linktab[unit] = ilt;
}
/*---------------------------------------------------------------------------*
* initialize this drivers linktab
*---------------------------------------------------------------------------*/
static void
ipr_init_linktab(int unit)
{
ipr_drvr_linktab[unit].unit = unit;
ipr_drvr_linktab[unit].bch_rx_data_ready = ipr_rx_data_rdy;
ipr_drvr_linktab[unit].bch_tx_queue_empty = ipr_tx_queue_empty;
ipr_drvr_linktab[unit].bch_activity = ipr_activity;
ipr_drvr_linktab[unit].line_connected = ipr_connect;
ipr_drvr_linktab[unit].line_disconnected = ipr_disconnect;
ipr_drvr_linktab[unit].dial_response = ipr_dialresponse;
ipr_drvr_linktab[unit].updown_ind = ipr_updown;
}
/*===========================================================================*/
Reference in New Issue View Git Blame Copy Permalink