diff options
author | Theo de Raadt <deraadt@cvs.openbsd.org> | 1996-05-22 11:48:26 +0000 |
---|---|---|
committer | Theo de Raadt <deraadt@cvs.openbsd.org> | 1996-05-22 11:48:26 +0000 |
commit | 18762c94577cb8e91781bad751b969bc8052998f (patch) | |
tree | 61a64e353d6702a02c48a723781074ad40a36799 /sys/net | |
parent | b38ed5ae00295759a4ccd7ba7032cd145339ce9c (diff) |
sync
Diffstat (limited to 'sys/net')
-rw-r--r-- | sys/net/if_fddisubr.c | 12 | ||||
-rw-r--r-- | sys/net/if_strip.c | 1714 | ||||
-rw-r--r-- | sys/net/if_stripvar.h | 54 |
3 files changed, 1774 insertions, 6 deletions
diff --git a/sys/net/if_fddisubr.c b/sys/net/if_fddisubr.c index 20ff08117e4..eced9b4a4e0 100644 --- a/sys/net/if_fddisubr.c +++ b/sys/net/if_fddisubr.c @@ -1,4 +1,4 @@ -/* $NetBSD: if_fddisubr.c,v 1.4 1996/05/07 02:40:32 thorpej Exp $ */ +/* $NetBSD: if_fddisubr.c,v 1.5 1996/05/07 23:20:21 christos Exp $ */ /* * Copyright (c) 1995 @@ -142,9 +142,9 @@ fddi_output(ifp, m0, dst, rt0) if ((ifp->if_flags & (IFF_UP|IFF_RUNNING)) != (IFF_UP|IFF_RUNNING)) senderr(ENETDOWN); ifp->if_lastchange = time; - if (rt = rt0) { + if ((rt = rt0) != NULL) { if ((rt->rt_flags & RTF_UP) == 0) { - if (rt0 = rt = RTALLOC1(dst, 1)) + if ((rt0 = rt = RTALLOC1(dst, 1)) != NULL) rt->rt_refcnt--; else senderr(EHOSTUNREACH); @@ -209,9 +209,9 @@ fddi_output(ifp, m0, dst, rt0) if (rt && (sdl = (struct sockaddr_dl *)rt->rt_gateway) && sdl->sdl_family == AF_LINK && sdl->sdl_alen > 0) { bcopy(LLADDR(sdl), (caddr_t)edst, sizeof(edst)); - } else if (error = + } else if ((error = iso_snparesolve(ifp, (struct sockaddr_iso *)dst, - (char *)edst, &snpalen)) + (char *)edst, &snpalen)) != 0) goto bad; /* Not Resolved */ /* If broadcasting on a simplex interface, loopback a copy */ if (*edst & 1) @@ -249,7 +249,7 @@ fddi_output(ifp, m0, dst, rt0) /* case AF_NSAP: */ case AF_CCITT: { register struct sockaddr_dl *sdl = - (struct sockaddr_dl *) rt -> rt_gateway; + (struct sockaddr_dl *) rt->rt_gateway; if (sdl && sdl->sdl_family == AF_LINK && sdl->sdl_alen > 0) { diff --git a/sys/net/if_strip.c b/sys/net/if_strip.c new file mode 100644 index 00000000000..7256fdcc4ef --- /dev/null +++ b/sys/net/if_strip.c @@ -0,0 +1,1714 @@ +/* $NetBSD: if_strip.c,v 1.2 1996/05/19 22:09:36 jonathan Exp $ */ +/* from: NetBSD: if_sl.c,v 1.38 1996/02/13 22:00:23 christos Exp $ */ + +/* + * Copyright 1996 The Board of Trustees of The Leland Stanford + * Junior University. All Rights Reserved. + * + * Permission to use, copy, modify, and distribute this + * software and its documentation for any purpose and without + * fee is hereby granted, provided that the above copyright + * notice appear in all copies. Stanford University + * makes no representations about the suitability of this + * software for any purpose. It is provided "as is" without + * express or implied warranty. + * + * + * This driver was contributed by Jonathan Stone. + * + * Starmode Radio IP interface (STRIP) for Metricom wireless radio. + * This STRIP driver assumes address resolution of IP addresses to + * Metricom MAC addresses is done via local link-level routes. + * The link-level addresses are entered as an 8-digit packed BCD number. + * To add a route for a radio at IP address 10.1.2.3, with radio + * address '1234-5678', reachable via interface st0, use the command + * + * route add -host 10.1.2.3 -link st0:12:34:56:78 + */ + + +/* + * Copyright (c) 1987, 1989, 1992, 1993 + * The Regents of the University of California. 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. + * 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. + * + * @(#)if_sl.c 8.6 (Berkeley) 2/1/94 + */ + +/* + * Derived from: Serial Line interface written by Rick Adams (rick@seismo.gov) + * + * Rick Adams + * Center for Seismic Studies + * 1300 N 17th Street, Suite 1450 + * Arlington, Virginia 22209 + * (703)276-7900 + * rick@seismo.ARPA + * seismo!rick + * + * Pounded on heavily by Chris Torek (chris@mimsy.umd.edu, umcp-cs!chris). + * N.B.: this belongs in netinet, not net, the way it stands now. + * Should have a link-layer type designation, but wouldn't be + * backwards-compatible. + * + * Converted to 4.3BSD Beta by Chris Torek. + * Other changes made at Berkeley, based in part on code by Kirk Smith. + * W. Jolitz added slip abort. + * + * Hacked almost beyond recognition by Van Jacobson (van@helios.ee.lbl.gov). + * Added priority queuing for "interactive" traffic; hooks for TCP + * header compression; ICMP filtering (at 2400 baud, some cretin + * pinging you can use up all your bandwidth). Made low clist behavior + * more robust and slightly less likely to hang serial line. + * Sped up a bunch of things. + * + * Note that splimp() is used throughout to block both (tty) input + * interrupts and network activity; thus, splimp must be >= spltty. + */ + +#include "strip.h" +#if NSTRIP > 0 + +#include "bpfilter.h" + +#include <sys/param.h> +#include <sys/proc.h> +#include <sys/mbuf.h> +#include <sys/buf.h> +#include <sys/dkstat.h> +#include <sys/socket.h> +#include <sys/ioctl.h> +#include <sys/file.h> +#include <sys/tty.h> +#include <sys/kernel.h> +#include <sys/conf.h> +#if __NetBSD__ +#include <sys/systm.h> +#endif +#include <sys/syslog.h> + +#include <machine/cpu.h> + +#include <net/if.h> +#include <net/if_dl.h> +#include <net/if_types.h> +#include <net/netisr.h> +#include <net/route.h> + +#if INET +#include <netinet/in.h> +#include <netinet/in_systm.h> +#include <netinet/in_var.h> +#include <netinet/ip.h> +#else +#error Starmode Radio IP configured without configuring inet? +#endif + +#include <net/slcompress.h> +#include <net/if_stripvar.h> +#include <net/slip.h> + +#ifdef __NetBSD__ /* XXX -- jrs */ +typedef u_char ttychar_t; +#else +typedef char ttychar_t; +#endif + +#if NBPFILTER > 0 +#include <sys/time.h> +#include <net/bpf.h> +#endif + +/* + * SLMAX is a hard limit on input packet size. To simplify the code + * and improve performance, we require that packets fit in an mbuf + * cluster, and if we get a compressed packet, there's enough extra + * room to expand the header into a max length tcp/ip header (128 + * bytes). So, SLMAX can be at most + * MCLBYTES - 128 + * + * SLMTU is a hard limit on output packet size. To insure good + * interactive response, SLMTU wants to be the smallest size that + * amortizes the header cost. (Remember that even with + * type-of-service queuing, we have to wait for any in-progress + * packet to finish. I.e., we wait, on the average, 1/2 * mtu / + * cps, where cps is the line speed in characters per second. + * E.g., 533ms wait for a 1024 byte MTU on a 9600 baud line. The + * average compressed header size is 6-8 bytes so any MTU > 90 + * bytes will give us 90% of the line bandwidth. A 100ms wait is + * tolerable (500ms is not), so want an MTU around 296. (Since TCP + * will send 256 byte segments (to allow for 40 byte headers), the + * typical packet size on the wire will be around 260 bytes). In + * 4.3tahoe+ systems, we can set an MTU in a route so we do that & + * leave the interface MTU relatively high (so we don't IP fragment + * when acting as a gateway to someone using a stupid MTU). + * + * Similar considerations apply to SLIP_HIWAT: It's the amount of + * data that will be queued 'downstream' of us (i.e., in clists + * waiting to be picked up by the tty output interrupt). If we + * queue a lot of data downstream, it's immune to our t.o.s. queuing. + * E.g., if SLIP_HIWAT is 1024, the interactive traffic in mixed + * telnet/ftp will see a 1 sec wait, independent of the mtu (the + * wait is dependent on the ftp window size but that's typically + * 1k - 4k). So, we want SLIP_HIWAT just big enough to amortize + * the cost (in idle time on the wire) of the tty driver running + * off the end of its clists & having to call back slstart for a + * new packet. For a tty interface with any buffering at all, this + * cost will be zero. Even with a totally brain dead interface (like + * the one on a typical workstation), the cost will be <= 1 character + * time. So, setting SLIP_HIWAT to ~100 guarantees that we'll lose + * at most 1% while maintaining good interactive response. + */ +#if NBPFILTER > 0 +#define BUFOFFSET (128+sizeof(struct ifnet **)+SLIP_HDRLEN) +#else +#define BUFOFFSET (128+sizeof(struct ifnet **)) +#endif +#define SLMAX (MCLBYTES - BUFOFFSET) +#define SLBUFSIZE (SLMAX + BUFOFFSET) +#define SLMTU 1200 /*XXX*/ + +#define SLIP_HIWAT roundup(50,CBSIZE) + +#ifndef __NetBSD__ /* XXX - cgd */ +#define CLISTRESERVE 1024 /* Can't let clists get too low */ +#endif /* !__NetBSD__ */ + +/* + * SLIP ABORT ESCAPE MECHANISM: + * (inspired by HAYES modem escape arrangement) + * 1sec escape 1sec escape 1sec escape { 1sec escape 1sec escape } + * within window time signals a "soft" exit from slip mode by remote end + * if the IFF_DEBUG flag is on. + */ +#define ABT_ESC '\033' /* can't be t_intr - distant host must know it*/ +#define ABT_IDLE 1 /* in seconds - idle before an escape */ +#define ABT_COUNT 3 /* count of escapes for abort */ +#define ABT_WINDOW (ABT_COUNT*2+2) /* in seconds - time to count */ + +struct st_softc st_softc[NSTRIP]; + +#define STRIP_FRAME_END 0x0D /* carriage return */ + + +static int stripinit __P((struct st_softc *)); +static struct mbuf *strip_btom __P((struct st_softc *, int)); + +/* + * STRIP header: '*' + modem address (dddd-dddd) + '*' + mactype ('SIP0') + * A Metricom packet looks like this: *<address>*<key><payload><CR> + * eg. *0000-1164*SIP0<payload><CR> + * + */ + +#define STRIP_ENCAP_SIZE(X) ((36) + (X)*65/64 + 2) +#define STRIP_HDRLEN 15 +#define STRIP_MAC_ADDR_LEN 9 + +/* + * Star mode packet header. + * (may be used for encapsulations other than STRIP.) + */ +#define STARMODE_ADDR_LEN 11 +struct st_header { + u_char starmode_addr[STARMODE_ADDR_LEN]; + u_char starmode_type[4]; +}; + +/* + * Forward declarations for Metricom-specific functions. + * Ideally, these would be in a library and shared across + * different STRIP implementations: *BSD, Linux, etc. + * + */ +static u_char* UnStuffData __P((u_char *src, u_char *end, u_char + *dest, u_long dest_length)); + +static u_char* StuffData __P((u_char *src, u_long length, u_char *dest, + u_char **code_ptr_ptr)); + +static void RecErr __P((char *msg, struct st_softc *sc)); +static void RecERR_Message __P((struct st_softc *strip_info, + u_char *sendername, u_char *msg)); +void resetradio __P((struct st_softc *sc, struct tty *tp)); +void strip_esc __P((struct st_softc *sc, struct mbuf *m)); +int strip_newpacket __P((struct st_softc *sc, u_char *ptr, u_char *end)); +struct mbuf * strip_send __P((struct st_softc *sc, struct mbuf *m0)); + + +#ifdef DEBUG +void ipdump __P((const char *msg, u_char *p, int len)); +void stripdump __P((const char *msg, u_char *p, int len)); +void stripdumpm __P((const char *msg, struct mbuf *m, int len)); +#define DPRINTF(x) printf x +#define TXPRINTF(x) printf x/* causes outrageous delays */ +#define RXPRINTF(x) printf x /* causes outrageous delays */ +#else +#define DPRINTF(x) +#define TXPRINTF(x) +#define RXPRINTF(x) +#endif + +#define XDPRINTF(x) /* really verbose debugging */ + + +/* + * Radio reset macros. + * The Metricom radios are not particularly well-designed for + * use in packet mode (starmode). There's no easy way to tell + * when the radio is in starmode. Worse, when the radios are reset + * or power-cycled, they come back up in Hayes AT-emulation mode, + * and there's no good way for this driver to tell. + * We deal with this by peridically tickling the radio + * with an invalid starmode command. If the radio doesn't + * respond with an error, the driver knows to reset the radio. + */ + +#define FORCE_RESET(sc) \ + do {\ + printf("strip: XXX: reset state-machine not yet implemented in *BSD\n"); \ + } while (0) + +#define CLEAR_RESET_TIMER(sc) \ + do {\ + printf("strip: clearing reset timeout: not yet implemented in *BSD\n"); \ + } while (0) + + + +/* + * Called from boot code to establish sl interfaces. + */ +void +stripattach(n) + int n; +{ + register struct st_softc *sc; + register int i = 0; + + for (sc = st_softc; i < NSTRIP; sc++) { + sprintf(sc->sc_if.if_xname, "st%d", i++); + sc->sc_if.if_softc = sc; + sc->sc_unit = i; /* XXX */ + sc->sc_if.if_mtu = SLMTU; + sc->sc_if.if_flags = 0; + sc->sc_if.if_type = IFT_OTHER; +#if 0 + sc->sc_if.if_flags |= SC_AUTOCOMP /* | IFF_POINTOPOINT | IFF_MULTICAST*/; +#endif + sc->sc_if.if_type = IFT_SLIP; + sc->sc_if.if_ioctl = stripioctl; + sc->sc_if.if_output = stripoutput; + sc->sc_if.if_snd.ifq_maxlen = 50; + sc->sc_fastq.ifq_maxlen = 32; + if_attach(&sc->sc_if); +#if NBPFILTER > 0 + bpfattach(&sc->sc_bpf, &sc->sc_if, DLT_SLIP, SLIP_HDRLEN); +#endif + } +} + +static int +stripinit(sc) + register struct st_softc *sc; +{ + register caddr_t p; + + if (sc->sc_ep == (u_char *) 0) { + MCLALLOC(p, M_WAIT); + if (p) + sc->sc_ep = (u_char *)p + SLBUFSIZE; + else { + printf("sl%d: can't allocate buffer\n", sc - st_softc); + sc->sc_if.if_flags &= ~IFF_UP; + return (0); + } + } + + /* get buffer in which to unstuff input */ + if (sc->sc_rxbuf == (u_char *) 0) { + MCLALLOC(p, M_WAIT); + if (p) + sc->sc_rxbuf = (u_char *)p + SLBUFSIZE - SLMAX; + else { + printf("sl%d: can't allocate buffer\n", sc - st_softc); + sc->sc_if.if_flags &= ~IFF_UP; + return (0); + } + } + + /* get buffer in which to stuff output */ + if (sc->sc_txbuf == (u_char *) 0) { + MCLALLOC(p, M_WAIT); + if (p) + sc->sc_txbuf = (u_char *)p + SLBUFSIZE - SLMAX; + else { + printf("sl%d: can't allocate buffer\n", sc - st_softc); + + sc->sc_if.if_flags &= ~IFF_UP; + return (0); + } + } + + sc->sc_buf = sc->sc_ep - SLMAX; + sc->sc_mp = sc->sc_buf; + sl_compress_init(&sc->sc_comp, -1); + + return (1); +} + +/* + * Line specific open routine. + * Attach the given tty to the first available sl unit. + */ +/* ARGSUSED */ +int +stripopen(dev, tp) + dev_t dev; + register struct tty *tp; +{ + struct proc *p = curproc; /* XXX */ + register struct st_softc *sc; + register int nstrip; + int error; +#ifdef __NetBSD__ + int s; +#endif + + if ((error = suser(p->p_ucred, &p->p_acflag)) != 0) + return (error); + + if (tp->t_line == STRIPDISC) + return (0); + + for (nstrip = NSTRIP, sc = st_softc; --nstrip >= 0; sc++) + if (sc->sc_ttyp == NULL) { + if (stripinit(sc) == 0) + return (ENOBUFS); + tp->t_sc = (caddr_t)sc; + sc->sc_ttyp = tp; + sc->sc_if.if_baudrate = tp->t_ospeed; + ttyflush(tp, FREAD | FWRITE); +#ifdef __NetBSD__ + /* + * make sure tty output queue is large enough + * to hold a full-sized packet (including frame + * end, and a possible extra frame end). full-sized + * packet occupies a max of 2*SLMTU bytes (because + * of possible escapes), and add two on for frame + * ends. + */ + s = spltty(); + if (tp->t_outq.c_cn < 2*SLMTU+2) { + sc->sc_oldbufsize = tp->t_outq.c_cn; + sc->sc_oldbufquot = tp->t_outq.c_cq != 0; + + clfree(&tp->t_outq); + error = clalloc(&tp->t_outq, 3*SLMTU, 0); + if (error) { + splx(s); + return(error); + } + } else + sc->sc_oldbufsize = sc->sc_oldbufquot = 0; + splx(s); +#endif /* __NetBSD__ */ + s = spltty(); + resetradio(sc, tp); + splx(s); + + return (0); + } + return (ENXIO); +} + +/* + * Line specific close routine. + * Detach the tty from the sl unit. + */ +void +stripclose(tp) + struct tty *tp; +{ + register struct st_softc *sc; + int s; + + ttywflush(tp); + + DPRINTF(("stripclose: closing\n")); + s = splimp(); /* actually, max(spltty, splsoftnet) */ + tp->t_line = 0; + sc = (struct st_softc *)tp->t_sc; + if (sc != NULL) { + if_down(&sc->sc_if); + sc->sc_ttyp = NULL; + tp->t_sc = NULL; + MCLFREE((caddr_t)(sc->sc_ep - SLBUFSIZE)); + MCLFREE((caddr_t)(sc->sc_rxbuf - SLBUFSIZE + SLMAX)); /* XXX */ + MCLFREE((caddr_t)(sc->sc_txbuf - SLBUFSIZE + SLMAX)); /* XXX */ + sc->sc_ep = 0; + sc->sc_mp = 0; + sc->sc_buf = 0; + sc->sc_rxbuf = 0; + sc->sc_txbuf = 0; + } +#ifdef __NetBSD__ + /* if necessary, install a new outq buffer of the appropriate size */ + if (sc->sc_oldbufsize != 0) { + clfree(&tp->t_outq); + clalloc(&tp->t_outq, sc->sc_oldbufsize, sc->sc_oldbufquot); + } +#endif + splx(s); +} + +/* + * Line specific (tty) ioctl routine. + * Provide a way to get the sl unit number. + */ +/* ARGSUSED */ +int +striptioctl(tp, cmd, data, flag) + struct tty *tp; + u_long cmd; + caddr_t data; + int flag; +{ + struct st_softc *sc = (struct st_softc *)tp->t_sc; + + switch (cmd) { + case SLIOCGUNIT: + *(int *)data = sc->sc_unit; + break; + + default: + return (-1); + } + return (0); +} + +/*XXX*/ +/* + * Take an mbuf chain containing a SLIP packet, byte-stuff (escape) + * the packet, and enqueue it on the tty send queue. + */ +void +strip_esc(sc, m) + struct st_softc *sc; + struct mbuf *m; +{ + register struct tty *tp = sc->sc_ttyp; + register u_char *cp; + register u_char *ep; + struct mbuf *m2; + register int len; + u_char *stuffstate = NULL; + + while (m) { + cp = mtod(m, u_char *); ep = cp + m->m_len; + /* + * Find out how many bytes in the string we can + * handle without doing something special. + */ + ep = StuffData(cp, m->m_len, sc->sc_txbuf, &stuffstate); + len = ep - sc->sc_txbuf; + + /* + * Put n characters at once + * into the tty output queue. + */ + if (b_to_q((ttychar_t *)sc->sc_txbuf, + len, &tp->t_outq)) + goto bad; + sc->sc_if.if_obytes += len; + MFREE(m, m2); + m = m2; + } + return; + +bad: + m_freem(m); + return; +} + +/* + * Prepend a STRIP header to the packet. + * (based on 4.4bsd if_ppp) + */ +struct mbuf * +strip_send(sc, m0) + struct st_softc *sc; + struct mbuf *m0; +{ + register struct tty *tp = sc->sc_ttyp; + struct st_header *hdr; + + /* + * Send starmode header (unstuffed). + */ + hdr = mtod(m0, struct st_header *); + if (b_to_q((ttychar_t *)hdr, STRIP_HDRLEN, &tp->t_outq)) { + TXPRINTF(("prepend: outq overflow\n")); + m_freem(m0); + } + + /* XXX undo M_PREPEND() */ + m0->m_data += sizeof(struct st_header); + m0->m_len -= sizeof(struct st_header); + if (m0 && m0->m_flags & M_PKTHDR) + m0->m_pkthdr.len -= sizeof(struct st_header); + + + strip_esc(sc, m0); + + if (putc(STRIP_FRAME_END, &tp->t_outq)) { + /* + * Not enough room. Remove a char to make room + * and end the packet normally. + * If you get many collisions (more than one or two + * a day) you probably do not have enough clists + * and you should increase "nclist" in param.c. + */ + (void) unputc(&tp->t_outq); + (void) putc(STRIP_FRAME_END, &tp->t_outq); + sc->sc_if.if_collisions++; + } else { + ++sc->sc_if.if_obytes; + sc->sc_if.if_opackets++; + } + return(m0); +} + + + +/* + * Queue a packet. Start transmission if not active. + * Compression happens in slstart; if we do it here, IP TOS + * will cause us to not compress "background" packets, because + * ordering gets trashed. It can be done for all packets in slstart. + */ +int +stripoutput(ifp, m, dst, rt) + struct ifnet *ifp; + register struct mbuf *m; + struct sockaddr *dst; + struct rtentry *rt; +{ + register struct st_softc *sc = ifp->if_softc; + register struct ip *ip; + register struct ifqueue *ifq; + register struct st_header *shp; + register const u_char *dldst; /* link-level next-hop */ + int s; + u_char dl_addrbuf[STARMODE_ADDR_LEN+1]; + + + /* + * Verify tty line is up and alive. + */ + if (sc->sc_ttyp == NULL) { + m_freem(m); + return (ENETDOWN); /* sort of */ + } + if ((sc->sc_ttyp->t_state & TS_CARR_ON) == 0 && + (sc->sc_ttyp->t_cflag & CLOCAL) == 0) { + m_freem(m); + return (EHOSTUNREACH); + } + +#define SDL(a) ((struct sockaddr_dl *) (a)) + +#ifdef DEBUG + if (rt) { + printf("stripout, rt: dst af%d gw af%d", + rt_key(rt)->sa_family, + rt->rt_gateway->sa_family); + if (rt_key(rt)->sa_family == AF_INET) + printf(" dst %x", + ((struct sockaddr_in *)rt_key(rt))->sin_addr.s_addr); + printf("\n"); + } +#endif + switch (dst->sa_family) { + + case AF_INET: + /* XXX untested */ + + if (rt != NULL && rt->rt_gwroute != NULL) + rt = rt->rt_gwroute; + + /* assume rt is never NULL */ + if (rt == NULL || rt->rt_gateway->sa_family != AF_LINK + || SDL(rt->rt_gateway)->sdl_alen != ifp->if_addrlen) { + DPRINTF(("strip: could not arp starmode addr %x\n", + ((struct sockaddr_in *)dst)->sin_addr.s_addr)); + m_freem(m); + return(EHOSTUNREACH); + } + /*bcopy(LLADDR(SDL(rt->rt_gateway)), dldst, ifp->if_addrlen);*/ + dldst = LLADDR(SDL(rt->rt_gateway)); + break; + + case AF_LINK: + /*bcopy(LLADDR(SDL(rt->rt_gateway)), dldst, ifp->if_addrlen);*/ + dldst = LLADDR(SDL(dst)); + break; + + default: + /* + * `Cannot happen' (see stripioctl). Someday we will extend + * the line protocol to support other address families. + */ + printf("%s: af %d not supported\n", sc->sc_if.if_xname, + dst->sa_family); + m_freem(m); + sc->sc_if.if_noproto++; + return (EAFNOSUPPORT); + } + + ifq = &sc->sc_if.if_snd; + ip = mtod(m, struct ip *); + if (sc->sc_if.if_flags & SC_NOICMP && ip->ip_p == IPPROTO_ICMP) { + m_freem(m); + return (ENETRESET); /* XXX ? */ + } + if (ip->ip_tos & IPTOS_LOWDELAY) + ifq = &sc->sc_fastq; + + /* + * Add local net header. If no space in first mbuf, + * add another. + */ + M_PREPEND(m, sizeof(struct st_header), M_DONTWAIT); + if (m == 0) { + DPRINTF(("strip: could not prepend starmode header\n")); + return(ENOBUFS); + } + + + /* + * Unpack BCD route entry into an ASCII starmode address. + */ + + dl_addrbuf[0] = '*'; + + dl_addrbuf[1] = ((dldst[0] >> 4) & 0x0f) + '0'; + dl_addrbuf[2] = ((dldst[0] ) & 0x0f) + '0'; + + dl_addrbuf[3] = ((dldst[1] >> 4) & 0x0f) + '0'; + dl_addrbuf[4] = ((dldst[1] ) & 0x0f) + '0'; + + dl_addrbuf[5] = '-'; + + dl_addrbuf[6] = ((dldst[2] >> 4) & 0x0f) + '0'; + dl_addrbuf[7] = ((dldst[2] ) & 0x0f) + '0'; + + dl_addrbuf[8] = ((dldst[3] >> 4) & 0x0f) + '0'; + dl_addrbuf[9] = ((dldst[3] ) & 0x0f) + '0'; + + dl_addrbuf[10] = '*'; + dl_addrbuf[11] = 0; + dldst = dl_addrbuf; + + shp = mtod(m, struct st_header *); + bcopy((caddr_t)"SIP0", (caddr_t)&shp->starmode_type, + sizeof(shp->starmode_type)); + + bcopy((caddr_t)dldst, (caddr_t)shp->starmode_addr, + sizeof (shp->starmode_addr)); + + TXPRINTF(("strip address is %16s\n", (char *)shp)); + + s = splimp(); + if (sc->sc_oqlen && sc->sc_ttyp->t_outq.c_cc == sc->sc_oqlen) { + struct timeval tv; + + /* if output's been stalled for too long, and restart */ + timersub(&time, &sc->sc_if.if_lastchange, &tv); + if (tv.tv_sec > 0) { + /*XXX*/ DPRINTF(("stripoutput: stalled, resetting\n")); + sc->sc_otimeout++; + stripstart(sc->sc_ttyp); + } + } + if (IF_QFULL(ifq)) { + IF_DROP(ifq); + m_freem(m); + splx(s); + sc->sc_if.if_oerrors++; + /*XXX*/ TXPRINTF(("stripoutput: ifq full\n")); + return (ENOBUFS); + } + IF_ENQUEUE(ifq, m); + sc->sc_if.if_lastchange = time; + if ((sc->sc_oqlen = sc->sc_ttyp->t_outq.c_cc) == 0) { + /*XXX*/ TXPRINTF(("stripoutput: enqueued pkt, restarting\n")); + stripstart(sc->sc_ttyp); + } +/* XXX FIXME */ + stripstart(sc->sc_ttyp); + splx(s); + return (0); +} + +/* + * Start output on interface. Get another datagram + * to send from the interface queue and map it to + * the interface before starting output. + */ +void +stripstart(tp) + register struct tty *tp; +{ + register struct st_softc *sc = (struct st_softc *)tp->t_sc; + register struct mbuf *m; + register struct ip *ip; + int s; +#if NBPFILTER > 0 + u_char bpfbuf[SLMTU + SLIP_HDRLEN]; + register int len = 0; +#endif +#ifndef __NetBSD__ /* XXX - cgd */ + extern int cfreecount; +#endif + for (;;) { +/*XXX*/ TXPRINTF(("stripstart\n")); + /* + * If there is more in the output queue, just send it now. + * We are being called in lieu of ttstart and must do what + * it would. + */ + if (tp->t_outq.c_cc != 0) { + (*tp->t_oproc)(tp); + if (tp->t_outq.c_cc > SLIP_HIWAT) { + TXPRINTF(("stripstart: outq past SLIP_HIWAT\n")); +#if 0 + /* XXX can't just stop output on + framed packet-radio links! + */ + return; +#endif + } + } + /* + * This happens briefly when the line shuts down. + */ + if (sc == NULL) { + TXPRINTF(("(shutdown)\n")); + return; + } + +#if 0 /* XXX - jrs*/ +#if defined(__NetBSD__) /* XXX - cgd */ + /* + * Do not remove the packet from the IP queue if it + * doesn't look like the packet will fit into the + * current serial output queue, with a packet full of + * escapes this could be as bad as SLMTU*2+2. + */ + if (tp->t_outq.c_cn - tp->t_outq.c_cc < 2*SLMTU+2) + return; +#endif /* __NetBSD__ */ +#endif + /* + * Get a packet and send it to the interface. + */ + s = splimp(); + IF_DEQUEUE(&sc->sc_fastq, m); + if (m) + sc->sc_if.if_omcasts++; /* XXX */ + else + IF_DEQUEUE(&sc->sc_if.if_snd, m); + splx(s); + if (m == NULL) { +/*XXX*/ TXPRINTF(("(empty q)\n")); + return; + } + /* + * We do the header compression here rather than in stripoutput + * because the packets will be out of order if we are using TOS + * queueing, and the connection id compression will get + * munged when this happens. + */ +#if NBPFILTER > 0 + if (sc->sc_bpf) { + /* + * We need to save the TCP/IP header before it's + * compressed. To avoid complicated code, we just + * copy the entire packet into a stack buffer (since + * this is a serial line, packets should be short + * and/or the copy should be negligible cost compared + * to the packet transmission time). + */ + register struct mbuf *m1 = m; + register u_char *cp = bpfbuf + SLIP_HDRLEN; + + len = 0; + do { + register int mlen = m1->m_len; + + bcopy(mtod(m1, caddr_t), cp, mlen); + cp += mlen; + len += mlen; + } while ((m1 = m1->m_next) != NULL); + } +#endif + if ((ip = mtod(m, struct ip *))->ip_p == IPPROTO_TCP) { + if (sc->sc_if.if_flags & SC_COMPRESS) + *mtod(m, u_char *) |= sl_compress_tcp(m, ip, + &sc->sc_comp, 1); + } +#if NBPFILTER > 0 + if (sc->sc_bpf) { + /* + * Put the SLIP pseudo-"link header" in place. The + * compressed header is now at the beginning of the + * mbuf. + */ + bpfbuf[SLX_DIR] = SLIPDIR_OUT; + bcopy(mtod(m, caddr_t), &bpfbuf[SLX_CHDR], CHDR_LEN); + bpf_tap(sc->sc_bpf, bpfbuf, len + SLIP_HDRLEN); + } +#endif + sc->sc_if.if_lastchange = time; + +#ifndef __NetBSD__ /* XXX - cgd */ + /* + * If system is getting low on clists, just flush our + * output queue (if the stuff was important, it'll get + * retransmitted). + */ + if (cfreecount < CLISTRESERVE + SLMTU) { + m_freem(m); + sc->sc_if.if_collisions++; + continue; + } +#endif /* !__NetBSD__ */ + + + if (strip_send(sc, m) == NULL) { +/*XXX*/ DPRINTF(("stripsend: failed to send pkt\n")); + } + } +} + + + +/* + * Copy data buffer to mbuf chain; add ifnet pointer. + */ +static struct mbuf * +strip_btom(sc, len) + register struct st_softc *sc; + register int len; +{ + register struct mbuf *m; + + MGETHDR(m, M_DONTWAIT, MT_DATA); + if (m == NULL) + return (NULL); + + /* + * If we have more than MHLEN bytes, it's cheaper to + * queue the cluster we just filled & allocate a new one + * for the input buffer. Otherwise, fill the mbuf we + * allocated above. Note that code in the input routine + * guarantees that packet will fit in a cluster. + */ + if (len >= MHLEN) { + MCLGET(m, M_DONTWAIT); + if ((m->m_flags & M_EXT) == 0) { + /* + * we couldn't get a cluster - if memory's this + * low, it's time to start dropping packets. + */ + (void) m_free(m); + return (NULL); + } + sc->sc_ep = mtod(m, u_char *) + SLBUFSIZE; + m->m_data = (caddr_t)sc->sc_buf; + m->m_ext.ext_buf = (caddr_t)((long)sc->sc_buf &~ MCLOFSET); + TXPRINTF(("strip_btom: new cluster for sc_buf\n")); + XDPRINTF(("XXX 1: sc_buf %x end %x hardlim %x\n", + sc->sc_buf, sc->sc_mp, sc->sc_ep)); + } else + bcopy((caddr_t)sc->sc_buf, mtod(m, caddr_t), len); + + m->m_len = len; + m->m_pkthdr.len = len; + m->m_pkthdr.rcvif = &sc->sc_if; + return (m); +} + +/* + * tty interface receiver interrupt. + * + * Called with a single char from the tty receiver interrupt; put + * the char into the buffer containing a partial packet. If the + * char is a packet delimiter, decapsulate the packet, wrap it in + * an mbuf, and put it on the protocol input queue. +*/ +void +stripinput(c, tp) + register int c; + register struct tty *tp; +{ + register struct st_softc *sc; + register struct mbuf *m; + register int len; + int s; +#if NBPFILTER > 0 + u_char chdr[CHDR_LEN]; +#endif + + tk_nin++; + sc = (struct st_softc *)tp->t_sc; + if (sc == NULL) + return; + if (c & TTY_ERRORMASK || ((tp->t_state & TS_CARR_ON) == 0 && + (tp->t_cflag & CLOCAL) == 0)) { + sc->sc_flags |= SC_ERROR; + DPRINTF(("strip: input, error %x\n", c)); /* XXX */ + return; + } + c &= TTY_CHARMASK; + + ++sc->sc_if.if_ibytes; + + switch (c) { + +#ifdef notanymore + case 0x0a: + /* (leading newline characters are ignored) */ + if (sc->sc_mp - sc->sc_buf == 0) + return; +#endif + + + case STRIP_FRAME_END: + len = sc->sc_mp - sc->sc_buf; + +#ifdef XDEBUG + if (len < 15 || sc->sc_flags & SC_ERROR) + printf("stripinput: end of pkt, len %d, err %d\n", + len, sc->sc_flags & SC_ERROR); /*XXX*/ +#endif + if(sc->sc_flags & SC_ERROR) { + sc->sc_flags &= ~SC_ERROR; + goto newpack; + } + + len = strip_newpacket(sc, sc->sc_buf, sc->sc_mp); + if (len <= 1) + /* less than min length packet - ignore */ + goto newpack; +#if DEBUG > 1 + ipdump("after destuff", sc->sc_buf, len); +#endif /* DEBUG */ + + + +#if NBPFILTER > 0 + if (sc->sc_bpf) { + /* + * Save the compressed header, so we + * can tack it on later. Note that we + * will end up copying garbage in some + * cases but this is okay. We remember + * where the buffer started so we can + * compute the new header length. + */ + bcopy(sc->sc_buf, chdr, CHDR_LEN); + } +#endif + + if ((c = (*sc->sc_buf & 0xf0)) != (IPVERSION << 4)) { + if (c & 0x80) + c = TYPE_COMPRESSED_TCP; + else if (c == TYPE_UNCOMPRESSED_TCP) + *sc->sc_buf &= 0x4f; /* XXX */ + /* + * 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 & SC_COMPRESS) { + len = sl_uncompress_tcp(&sc->sc_buf, len, + (u_int)c, &sc->sc_comp); + if (len <= 0) + goto error; + } else if ((sc->sc_if.if_flags & SC_AUTOCOMP) && + c == TYPE_UNCOMPRESSED_TCP && len >= 40) { + len = sl_uncompress_tcp(&sc->sc_buf, len, + (u_int)c, &sc->sc_comp); + if (len <= 0) + goto error; + sc->sc_if.if_flags |= SC_COMPRESS; + } else + goto error; + } +#if NBPFILTER > 0 + if (sc->sc_bpf) { + /* + * Put the SLIP pseudo-"link header" in place. + * We couldn't do this any earlier since + * decompression probably moved the buffer + * pointer. Then, invoke BPF. + */ + register u_char *hp = sc->sc_buf - SLIP_HDRLEN; + + hp[SLX_DIR] = SLIPDIR_IN; + bcopy(chdr, &hp[SLX_CHDR], CHDR_LEN); + bpf_tap(sc->sc_bpf, hp, len + SLIP_HDRLEN); + } +#endif + m = strip_btom(sc, len); + if (m == NULL) + goto error; + + sc->sc_if.if_ipackets++; + sc->sc_if.if_lastchange = time; + s = splimp(); + if (IF_QFULL(&ipintrq)) { + IF_DROP(&ipintrq); + DPRINTF(("stripinput: ipintrq full\n")); + sc->sc_if.if_ierrors++; + sc->sc_if.if_iqdrops++; + m_freem(m); + } else { + IF_ENQUEUE(&ipintrq, m); + schednetisr(NETISR_IP); + } + splx(s); + goto newpack; + } + + if (sc->sc_mp < sc->sc_ep) { + *sc->sc_mp++ = c; + /*sc->sc_escape = 0;*/ + return; + } + + /* can't put lower; would miss an extra frame */ + sc->sc_flags |= SC_ERROR; + DPRINTF(("stripinput: overran buf\n")); + goto quiet_error; + +error: + RXPRINTF(("stripinput: error\n")); +quiet_error: + sc->sc_if.if_ierrors++; + goto quiet_newpack; + +newpack: + /*DPRINTF(("stripinput: newpack\n"));*/ /* XXX */ +quiet_newpack: + sc->sc_mp = sc->sc_buf = sc->sc_ep - SLMAX; + /*sc->sc_escape = 0;*/ +} + +/* + * Process an ioctl request. + */ +int +stripioctl(ifp, cmd, data) + register struct ifnet *ifp; + u_long cmd; + caddr_t data; +{ + register struct ifaddr *ifa = (struct ifaddr *)data; + register struct ifreq *ifr; + register int s = splimp(), error = 0; + + switch (cmd) { + + case SIOCSIFADDR: + if (ifa->ifa_addr->sa_family == AF_INET) + ifp->if_flags |= IFF_UP; + else + error = EAFNOSUPPORT; + break; + + case SIOCSIFDSTADDR: + if (ifa->ifa_addr->sa_family != AF_INET) + error = EAFNOSUPPORT; + break; + + case SIOCADDMULTI: + case SIOCDELMULTI: + ifr = (struct ifreq *)data; + if (ifr == 0) { + error = EAFNOSUPPORT; /* XXX */ + break; + } + switch (ifr->ifr_addr.sa_family) { + +#ifdef INET + case AF_INET: + break; +#endif + + default: + error = EAFNOSUPPORT; + break; + } + break; + + default: + +#ifdef DEBUG + printf("stripioctl: unknown request 0x%lx\n", cmd); +#endif + error = EINVAL; + } + splx(s); + return (error); +} +/* + * Strip subroutines + */ + +/* + * Set a radio into starmode. + */ +void +resetradio(sc, tp) + struct st_softc *sc; + struct tty *tp; +{ +#if 0 + static ttychar_t InitString[] = + "\r\n\r\n\r\nat\r\n\r\n\r\nate0dt**starmode\r\n**\r\n"; +#else + static ttychar_t InitString[] = + "\r\rat\r\r\rate0dt**starmode\r*\r"; +#endif + register int i; + + + DPRINTF(("strip: resetting radio\n")); + if ((i = b_to_q(InitString, sizeof(InitString) - 1, &tp->t_outq))) { + printf("resetradio: %d chars didn't fit in tty queue\n", i); + return; + } + sc->sc_if.if_obytes += sizeof(InitString) - 1; + +#ifdef linux /*XXX*/ + /* reset the watchdog counter */ + sc->watchdog_doprobe = jiffies + 10 * HZ; + sc->watchdog_doreset = jiffies + 1 * HZ; +#endif + /*XXX jrs DANGEROUS - does this help? */ + sc->sc_if.if_lastchange = time; + + /*XXX jrs DANGEROUS - does this work? */ + (*sc->sc_ttyp->t_oproc)(tp); +} + + +/* + * XXX + * The following is taken, with permisino of the author, from + * the LInux strip driver. + */ + + +/* + * Process a received packet. + */ +int +strip_newpacket(sc, ptr, end) + struct st_softc *sc; + register u_char *ptr, *end; +{ + register int len = ptr - end; + register u_char *name, *name_end; + u_int packetlen; + + /* Ignore empty lines */ + if (len == 0) return 0; + + /* Catch 'OK' responses which show radio has fallen out of starmode */ + if (len >= 2 && ptr[0] == 'O' && ptr[1] == 'K') { + printf("%s: Radio is back in AT command mode: will reset\n", + sc->sc_if.if_xname); + FORCE_RESET(sc); /* Do reset ASAP */ + return 0; + } + + /* Check for start of address marker, and then skip over it */ + if (*ptr != '*') { + /* Catch other error messages */ + if (ptr[0] == 'E' && ptr[1] == 'R' && ptr[2] == 'R' && ptr[3] == '_') + RecERR_Message(sc, NULL, ptr); /* XXX stuart? */ + else { + RecErr("No initial *", sc); + addlog("(len = %d\n", len); + } + return 0; + } + + /* skip the '*' */ + ptr++; + + /* Skip the return address */ + name = ptr; + while (ptr < end && *ptr != '*') + ptr++; + + /* Check for end of address marker, and skip over it */ + if (ptr == end) { + RecErr("No second *", sc); + XDPRINTF(("XXX 3: sc_buf %x ptr %x end %x mp %x hardlim %x\n", + sc->sc_buf, ptr, end, sc->sc_mp, sc->sc_ep)); + return 0; + } + name_end = ptr++; + + /* Check for SRIP key, and skip over it */ + if (ptr[0] != 'S' || ptr[1] != 'I' || ptr[2] != 'P' || ptr[3] != '0') { + if (ptr[0] == 'E' && ptr[1] == 'R' && ptr[2] == 'R' && + ptr[3] == '_') { + *name_end = 0; + RecERR_Message(sc, name, ptr); + } + else RecErr("No SRIP key", sc); + return 0; + } + ptr += 4; + + /* Decode start of the IP packet header */ + ptr = UnStuffData(ptr, end, sc->sc_rxbuf, 4); + if (!ptr) { + RecErr("Runt packet (hdr)", sc); + return 0; + } + + /* XXX is this the IP header length, or what? */ + packetlen = ((u_short)sc->sc_rxbuf[2] << 8) | sc->sc_rxbuf[3]; +/* printf("Packet %02x.%02x.%02x.%02x\n", + sc->sc_rxbuf[0], sc->sc_rxbuf[1], + sc->sc_rxbuf[2], sc->sc_rxbuf[3]); + printf("Got %d byte packet\n", packetlen); */ + + /* Decode remainder of the IP packer */ + ptr = UnStuffData(ptr, end, sc->sc_rxbuf+4, packetlen-4); + if (!ptr) { + RecErr("Short packet", sc); + return 0; + } + + /* XXX*/ bcopy(sc->sc_rxbuf, sc->sc_buf, packetlen ); + +#ifdef linux + strip_bump(sc, packetlen); +#endif + return(packetlen); +} + + +/* + * Stuffing scheme: + * 00 Unused (reserved character) + * 01-3F Run of 2-64 different characters + * 40-7F Run of 1-64 different characters plus a single zero at the end + * 80-BF Run of 1-64 of the same character + * C0-FF Run of 1-64 zeroes (ASCII 0) +*/ +typedef enum +{ + Stuff_Diff = 0x00, + Stuff_DiffZero = 0x40, + Stuff_Same = 0x80, + Stuff_Zero = 0xC0, + Stuff_NoCode = 0xFF, /* Special code, meaning no code selected */ + + Stuff_CodeMask = 0xC0, + Stuff_CountMask = 0x3F, + Stuff_MaxCount = 0x3F, + Stuff_Magic = 0x0D /* The value we are eliminating */ +} StuffingCode; + +/* + * StuffData encodes the data starting at "src" for "length" bytes. + * It writes it to the buffer pointed to by "dest" (which must be at least + * as long as 1 + 65/64 of the input length). The output may be up to 1.6% + * larger than the input for pathological input, but will usually be smaller. + * StuffData returns the new value of the dest pointer as its result. + * + * "code_ptr_ptr" points to a "u_char *" which is used to hold + * encoding state between calls, allowing an encoded packet to be + * incrementally built up from small parts. + * On the first call, the "u_char *" pointed to should be initialized + * to NULL; between subsequent calls the calling routine should leave + * the value alone and simply pass it back unchanged so that the + * encoder can recover its current state. + */ + +#define StuffData_FinishBlock(X) \ + (*code_ptr = (X) ^ Stuff_Magic, code = Stuff_NoCode) + +static u_char* +StuffData(u_char *src, u_long length, u_char *dest, u_char **code_ptr_ptr) +{ + u_char *end = src + length; + u_char *code_ptr = *code_ptr_ptr; + u_char code = Stuff_NoCode, count = 0; + + if (!length) return(dest); + + if (code_ptr) { /* Recover state from last call, if applicable */ + code = *code_ptr & Stuff_CodeMask; + count = *code_ptr & Stuff_CountMask; + } + + while (src < end) { + switch (code) { + /* + * Stuff_NoCode: If no current code, select one + */ + case Stuff_NoCode: + code_ptr = dest++; /* Record where we're going to put this code */ + count = 0; /* Reset the count (zero means one instance) */ + /* Tentatively start a new block */ + if (*src == 0) { + code = Stuff_Zero; + src++; + } else { + code = Stuff_Same; + *dest++ = *src++ ^ Stuff_Magic; + } + /* Note: We optimistically assume run of same -- which will be */ + /* fixed later in Stuff_Same if it turns out not to be true. */ + break; + + /* + * Stuff_Zero: We already have at least one zero encoded + */ + case Stuff_Zero: + + /* If another zero, count it, else finish this code block */ + if (*src == 0) { + count++; + src++; + } else + StuffData_FinishBlock(Stuff_Zero + count); + break; + + /* + * Stuff_Same: We already have at least one byte encoded + */ + case Stuff_Same: + /* If another one the same, count it */ + if ((*src ^ Stuff_Magic) == code_ptr[1]) { + count++; + src++; + break; + } + /* else, this byte does not match this block. */ + /* If we already have two or more bytes encoded, finish this code block */ + if (count) { + StuffData_FinishBlock(Stuff_Same + count); + break; + } + /* else, we only have one so far, so switch to Stuff_Diff code */ + code = Stuff_Diff; /* and fall through to Stuff_Diff case below */ + + case Stuff_Diff: /* Stuff_Diff: We have at least two *different* bytes encoded */ + /* If this is a zero, must encode a Stuff_DiffZero, and begin a new block */ + if (*src == 0) + StuffData_FinishBlock(Stuff_DiffZero + count); + /* else, if we have three in a row, it is worth starting a Stuff_Same block */ + else if ((*src ^ Stuff_Magic) == dest[-1] && dest[-1] == dest[-2]) + { + code += count-2; + if (code == Stuff_Diff) + code = Stuff_Same; + StuffData_FinishBlock(code); + code_ptr = dest-2; + /* dest[-1] already holds the correct value */ + count = 2; /* 2 means three bytes encoded */ + code = Stuff_Same; + } + /* else, another different byte, so add it to the block */ + else { + *dest++ = *src ^ Stuff_Magic; + count++; + } + src++; /* Consume the byte */ + break; + } + + if (count == Stuff_MaxCount) + StuffData_FinishBlock(code + count); + } + if (code == Stuff_NoCode) + *code_ptr_ptr = NULL; + else { + *code_ptr_ptr = code_ptr; + StuffData_FinishBlock(code + count); + } + + return(dest); +} + + + +/* + * UnStuffData decodes the data at "src", up to (but not including) + * "end". It writes the decoded data into the buffer pointed to by + * "dest", up to a maximum of "dest_length", and returns the new + * value of "src" so that a follow-on call can read more data, + * continuing from where the first left off. + * + * There are three types of results: + * 1. The source data runs out before extracting "dest_length" bytes: + * UnStuffData returns NULL to indicate failure. + * 2. The source data produces exactly "dest_length" bytes: + * UnStuffData returns new_src = end to indicate that all bytes + * were consumed. + * 3. "dest_length" bytes are extracted, with more + * remaining. UnStuffData returns new_src < end to indicate that + * there are more bytes to be read. + * + * Note: The decoding may be destructive, in that it may alter the + * source data in the process of decoding it (this is necessary to + * allow a follow-on call to resume correctly). + */ + +static u_char* +UnStuffData(u_char *src, u_char *end, u_char *dest, u_long dest_length) +{ + u_char *dest_end = dest + dest_length; + + if (!src || !end || !dest || !dest_length) + return(NULL); /* Sanity check */ + + while (src < end && dest < dest_end) { + int count = (*src ^ Stuff_Magic) & Stuff_CountMask; + switch ((*src ^ Stuff_Magic) & Stuff_CodeMask) + { + case Stuff_Diff: + if (src+1+count >= end) + return(NULL); + do + *dest++ = *++src ^ Stuff_Magic; + while(--count >= 0 && dest < dest_end); + if (count < 0) + src += 1; + else if (count == 0) + *src = Stuff_Same ^ Stuff_Magic; + else + *src = (Stuff_Diff + count) ^ Stuff_Magic; + break; + case Stuff_DiffZero: + if (src+1+count >= end) + return(NULL); + do + *dest++ = *++src ^ Stuff_Magic; + while(--count >= 0 && dest < dest_end); + if (count < 0) + *src = Stuff_Zero ^ Stuff_Magic; + else + *src = (Stuff_DiffZero + count) ^ Stuff_Magic; + break; + case Stuff_Same: + if (src+1 >= end) + return(NULL); + do + *dest++ = src[1] ^ Stuff_Magic; + while(--count >= 0 && dest < dest_end); + if (count < 0) + src += 2; + else + *src = (Stuff_Same + count) ^ Stuff_Magic; + break; + case Stuff_Zero: + do + *dest++ = 0; + while(--count >= 0 && dest < dest_end); + if (count < 0) + src += 1; + else + *src = (Stuff_Zero + count) ^ Stuff_Magic; + break; + } + } + + if (dest < dest_end) + return(NULL); + else + return(src); +} + + + +/* + * Log an error mesesage (for a packet received with errors?) + * rom the STRIP driver. + * XXX check with original author. + */ +static void +RecErr(msg, sc) + char *msg; + struct st_softc *sc; +{ + static const int MAX_RecErr = 80; + u_char *ptr = sc->sc_buf; + u_char *end = sc->sc_mp; + u_char pkt_text[MAX_RecErr], *p = pkt_text; + *p++ = '\"'; + while (ptr < end && p < &pkt_text[MAX_RecErr-4]) { + if (*ptr == '\\') { + *p++ = '\\'; + *p++ = '\\'; + } else if (*ptr >= 32 && *ptr <= 126) + *p++ = *ptr; + else { + sprintf(p, "\\%02x", *ptr); + p+= 3; + } + ptr++; + } + + if (ptr == end) *p++ = '\"'; + *p++ = 0; + addlog("%13s : %s\n", msg, pkt_text); + +#ifdef linux + set_bit(SLF_ERROR, &sc->flags); + sc->rx_errors++; +#endif /* linux */ + sc->sc_if.if_ierrors++; +} + +/* + * Log an error message for a packet recieved from a remote Metricom + * radio. Update the radio-reset timer if the message is one that + * is generated only in starmode. + * + * We only call this function when we have an error message from + * the radio, which can only happen after seeing a frame delimeter + * in the input-side routine; so it's safe to call the output side + * to reset the radio. + */ +static void +RecERR_Message(sc, sendername, msg) + struct st_softc *sc; + u_char *sendername; + u_char *msg; +{ + static const char ERR_001[] = "ERR_001 Not in StarMode!"; + static const char ERR_002[] = "ERR_002 Remap handle"; + static const char ERR_003[] = "ERR_003 Can't resolve name"; + static const char ERR_004[] = "ERR_004 Name too small or missing"; + static const char ERR_007[] = "ERR_007 Body too big"; + static const char ERR_008[] = "ERR_008 Bad character in name"; + + if (!strncmp(msg, ERR_001, sizeof(ERR_001)-1)) { + printf("Radio %s is not in StarMode\n", sendername); + } + else if (!strncmp(msg, ERR_002, sizeof(ERR_002)-1)) { +#ifdef notyet /*Kernel doesn't have scanf!*/ + int handle; + u_char newname[64]; + sscanf(msg, "ERR_002 Remap handle &%d to name %s", &handle, newname); + printf("Radio name %s is handle %d\n", newname, handle); +#endif + } + else if (!strncmp(msg, ERR_003, sizeof(ERR_003)-1)) { + printf("Radio name <unspecified> is unknown (\"Can't resolve name\" error)\n"); + } + else if (!strncmp(msg, ERR_004, sizeof(ERR_004)-1)) { + CLEAR_RESET_TIMER(sc); + /* printf("%s: Received tickle response; clearing watchdog_doreset timer.\n", + sc->sc_if.if_xname); */ + } + else if (!strncmp(msg, ERR_007, sizeof(ERR_007)-1)) { + /* Note: This error knoks the radio back into command mode. */ + printf("Error! Packet size <unspecified> is too big for radio."); + FORCE_RESET(sc); /* Do reset ASAP */ + } + else if (!strncmp(msg, ERR_008, sizeof(ERR_008)-1)) { + printf("Name <unspecified> contains illegal character\n"); + } + else RecErr("Error Msg:", sc); +} + +#ifdef DEBUG +void +stripdumpm(msg, m, len) + const char *msg; + struct mbuf *m; +{ + stripdump(msg, mtod(m, u_char*), len); + /*XXX*/ +} + +void +stripdump(msg, p, len) + const char *msg; + u_char *p; + int len; +{ + register int i; + + + printf(msg); + for (i = 0; i < STRIP_HDRLEN; i++) + printf("%c", p[i]); + printf("\n"); + + p += STRIP_HDRLEN; + for (i = 0; i < 32; i++) { + printf("%02x ", p[i]); + } + printf("\n"); +} + +void +ipdump(msg, p, len) + const char *msg; + u_char *p; + int len; +{ + register int i; + + printf(msg); + for (i = 0; i < 32; i++) { + printf("%02x ", p[i]); + } + printf("\n"); +} + +#endif /* DEBUG */ +#endif /* NSTRIP > 0 */ diff --git a/sys/net/if_stripvar.h b/sys/net/if_stripvar.h new file mode 100644 index 00000000000..30ef8eb668e --- /dev/null +++ b/sys/net/if_stripvar.h @@ -0,0 +1,54 @@ +/* $NetBSD: if_stripvar.h,v 1.2 1996/05/19 22:09:45 jonathan Exp $ */ + +/* + * Definitions for SLIP interface data structures + * + * (This exists so programs like slstats can get at the definition + * of sl_softc.) + */ +struct st_softc { + struct ifnet sc_if; /* network-visible interface */ + int sc_unit; /* XXX unit number */ + struct ifqueue sc_fastq; /* interactive output queue */ + struct tty *sc_ttyp; /* pointer to tty structure */ + u_char *sc_mp; /* pointer to next available buf char */ + u_char *sc_ep; /* pointer to last available buf char */ + u_char *sc_buf; /* input buffer */ + u_char *sc_rxbuf; /* input destuffing buffer */ + u_char *sc_txbuf; /* output stuffing buffer */ + u_int sc_flags; /* see below */ + u_int sc_escape; /* =1 if last char input was FRAME_ESCAPE */ + long sc_lasttime; /* last time a char arrived */ + long sc_abortcount; /* number of abort esacpe chars */ + long sc_starttime; /* time of first abort in window */ + long sc_oqlen; /* previous output queue size */ + long sc_otimeout; /* number of times output's stalled */ +#ifdef NetBSD + int sc_oldbufsize; /* previous output buffer size */ + int sc_oldbufquot; /* previous output buffer quoting */ +#endif +#ifdef INET /* XXX */ + struct slcompress sc_comp; /* tcp compression data */ +#endif + caddr_t sc_bpf; /* BPF data */ +}; + +/* internal flags */ +#define SC_ERROR 0x0001 /* had an input error */ + +/* visible flags */ +#define SC_COMPRESS IFF_LINK0 /* compress TCP traffic */ +#define SC_NOICMP IFF_LINK1 /* supress ICMP traffic */ +#define SC_AUTOCOMP IFF_LINK2 /* auto-enable TCP compression */ + +#ifdef _KERNEL +void stripattach __P((int n)); +void stripclose __P((struct tty *)); +void stripinput __P((int, struct tty *)); +int stripioctl __P((struct ifnet *, u_long, caddr_t)); +int stripopen __P((dev_t, struct tty *)); +int stripoutput __P((struct ifnet *, + struct mbuf *, struct sockaddr *, struct rtentry *)); +void stripstart __P((struct tty *)); +int striptioctl __P((struct tty *, u_long, caddr_t, int)); +#endif /* _KERNEL */ |