Home | History | Annotate | Line # | Download | only in net
if_ieee1394subr.c revision 1.5
      1  1.5  thorpej /*	$NetBSD: if_ieee1394subr.c,v 1.5 2000/12/13 22:07:51 thorpej Exp $	*/
      2  1.1     onoe 
      3  1.1     onoe /*
      4  1.1     onoe  * Copyright (c) 2000 The NetBSD Foundation, Inc.
      5  1.1     onoe  * All rights reserved.
      6  1.1     onoe  *
      7  1.1     onoe  * This code is derived from software contributed to The NetBSD Foundation
      8  1.1     onoe  * by Atsushi Onoe.
      9  1.1     onoe  *
     10  1.1     onoe  * Redistribution and use in source and binary forms, with or without
     11  1.1     onoe  * modification, are permitted provided that the following conditions
     12  1.1     onoe  * are met:
     13  1.1     onoe  * 1. Redistributions of source code must retain the above copyright
     14  1.1     onoe  *    notice, this list of conditions and the following disclaimer.
     15  1.1     onoe  * 2. Redistributions in binary form must reproduce the above copyright
     16  1.1     onoe  *    notice, this list of conditions and the following disclaimer in the
     17  1.1     onoe  *    documentation and/or other materials provided with the distribution.
     18  1.1     onoe  * 3. All advertising materials mentioning features or use of this software
     19  1.1     onoe  *    must display the following acknowledgement:
     20  1.1     onoe  *	This product includes software developed by the NetBSD
     21  1.1     onoe  *	Foundation, Inc. and its contributors.
     22  1.1     onoe  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23  1.1     onoe  *    contributors may be used to endorse or promote products derived
     24  1.1     onoe  *    from this software without specific prior written permission.
     25  1.1     onoe  *
     26  1.1     onoe  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27  1.1     onoe  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28  1.1     onoe  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29  1.1     onoe  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30  1.1     onoe  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31  1.1     onoe  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32  1.1     onoe  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33  1.1     onoe  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34  1.1     onoe  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35  1.1     onoe  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36  1.1     onoe  * POSSIBILITY OF SUCH DAMAGE.
     37  1.1     onoe  */
     38  1.1     onoe 
     39  1.1     onoe #include "opt_inet.h"
     40  1.1     onoe #include "bpfilter.h"
     41  1.1     onoe 
     42  1.1     onoe #include <sys/param.h>
     43  1.1     onoe #include <sys/systm.h>
     44  1.1     onoe #include <sys/types.h>
     45  1.1     onoe #include <sys/socket.h>
     46  1.1     onoe #include <sys/sockio.h>
     47  1.1     onoe #include <sys/kernel.h>
     48  1.1     onoe #include <sys/mbuf.h>
     49  1.1     onoe #include <sys/device.h>
     50  1.1     onoe 
     51  1.1     onoe #include <net/if.h>
     52  1.1     onoe #include <net/if_dl.h>
     53  1.1     onoe #include <net/if_ieee1394.h>
     54  1.1     onoe #include <net/if_types.h>
     55  1.1     onoe #include <net/if_media.h>
     56  1.1     onoe #include <net/ethertypes.h>
     57  1.1     onoe #include <net/netisr.h>
     58  1.1     onoe #include <net/route.h>
     59  1.1     onoe 
     60  1.1     onoe #if NBPFILTER > 0
     61  1.1     onoe #include <net/bpf.h>
     62  1.1     onoe #endif
     63  1.1     onoe 
     64  1.1     onoe #ifdef INET
     65  1.1     onoe #include <netinet/in.h>
     66  1.1     onoe #include <netinet/in_var.h>
     67  1.1     onoe #include <netinet/if_ieee1394arp.h>
     68  1.1     onoe #endif /* INET */
     69  1.1     onoe #ifdef INET6
     70  1.1     onoe #include <netinet/in.h>
     71  1.1     onoe #include <netinet6/in6_var.h>
     72  1.1     onoe #include <netinet6/nd6.h>
     73  1.1     onoe #endif /* INET6 */
     74  1.1     onoe 
     75  1.3     onoe #define	IEEE1394_REASS_TIMEOUT	3	/* 3 sec */
     76  1.3     onoe 
     77  1.1     onoe #define	senderr(e)	do { error = (e); goto bad; } while(0/*CONSTCOND*/)
     78  1.1     onoe 
     79  1.1     onoe static int  ieee1394_output(struct ifnet *, struct mbuf *, struct sockaddr *,
     80  1.1     onoe 		struct rtentry *);
     81  1.1     onoe static void ieee1394_input(struct ifnet *, struct mbuf *);
     82  1.2     onoe static struct mbuf *ieee1394_reass(struct ifnet *, struct mbuf *);
     83  1.1     onoe 
     84  1.1     onoe static int
     85  1.1     onoe ieee1394_output(struct ifnet *ifp, struct mbuf *m0, struct sockaddr *dst,
     86  1.1     onoe     struct rtentry *rt0)
     87  1.1     onoe {
     88  1.1     onoe 	u_int16_t etype = 0;
     89  1.2     onoe 	struct mbuf *m;
     90  1.2     onoe 	int s, hdrlen, error = 0;
     91  1.1     onoe 	struct rtentry *rt;
     92  1.1     onoe 	struct mbuf *mcopy = NULL;
     93  1.2     onoe 	struct ieee1394_hwaddr hwdst, *myaddr;
     94  1.1     onoe #ifdef INET
     95  1.1     onoe 	struct ieee1394_arphdr *ah;
     96  1.1     onoe #endif /* INET */
     97  1.5  thorpej 
     98  1.5  thorpej 	/*
     99  1.5  thorpej 	 * XXX ALTQ
    100  1.5  thorpej 	 */
    101  1.1     onoe 
    102  1.1     onoe 	if ((ifp->if_flags & (IFF_UP|IFF_RUNNING)) != (IFF_UP|IFF_RUNNING))
    103  1.1     onoe 		senderr(ENETDOWN);
    104  1.1     onoe 	ifp->if_lastchange = time;
    105  1.1     onoe 	if ((rt = rt0) != NULL) {
    106  1.1     onoe 		if ((rt->rt_flags & RTF_UP) == 0) {
    107  1.1     onoe 			if ((rt0 = rt = rtalloc1(dst, 1)) != NULL) {
    108  1.1     onoe 				rt->rt_refcnt--;
    109  1.1     onoe 				if (rt->rt_ifp != ifp)
    110  1.1     onoe 					return (*rt->rt_ifp->if_output)
    111  1.1     onoe 							(ifp, m0, dst, rt);
    112  1.1     onoe 			} else
    113  1.1     onoe 				senderr(EHOSTUNREACH);
    114  1.1     onoe 		}
    115  1.1     onoe 		if (rt->rt_flags & RTF_GATEWAY) {
    116  1.3     onoe 			if (rt->rt_gwroute == NULL)
    117  1.1     onoe 				goto lookup;
    118  1.1     onoe 			if (((rt = rt->rt_gwroute)->rt_flags & RTF_UP) == 0) {
    119  1.1     onoe 				rtfree(rt);
    120  1.1     onoe 				rt = rt0;
    121  1.1     onoe   lookup:
    122  1.1     onoe 				rt->rt_gwroute = rtalloc1(rt->rt_gateway, 1);
    123  1.3     onoe 				if ((rt = rt->rt_gwroute) == NULL)
    124  1.1     onoe 					senderr(EHOSTUNREACH);
    125  1.1     onoe 				/* the "G" test below also prevents rt == rt0 */
    126  1.1     onoe 				if ((rt->rt_flags & RTF_GATEWAY) ||
    127  1.1     onoe 				    (rt->rt_ifp != ifp)) {
    128  1.1     onoe 					rt->rt_refcnt--;
    129  1.3     onoe 					rt0->rt_gwroute = NULL;
    130  1.1     onoe 					senderr(EHOSTUNREACH);
    131  1.1     onoe 				}
    132  1.1     onoe 			}
    133  1.1     onoe 		}
    134  1.1     onoe 		if (rt->rt_flags & RTF_REJECT)
    135  1.1     onoe 			if (rt->rt_rmx.rmx_expire == 0 ||
    136  1.1     onoe 			    time.tv_sec < rt->rt_rmx.rmx_expire)
    137  1.1     onoe 				senderr(rt == rt0 ? EHOSTDOWN : EHOSTUNREACH);
    138  1.1     onoe 	}
    139  1.1     onoe 	switch (dst->sa_family) {
    140  1.1     onoe #ifdef INET
    141  1.1     onoe 	case AF_INET:
    142  1.2     onoe 		if (m0->m_flags & (M_BCAST | M_MCAST))
    143  1.1     onoe 			memcpy(&hwdst, ifp->if_broadcastaddr, sizeof(hwdst));
    144  1.2     onoe 		else if (!ieee1394arpresolve(ifp, rt, m0, dst, &hwdst))
    145  1.1     onoe 			return 0;	/* if not yet resolved */
    146  1.1     onoe 		/* if broadcasting on a simplex interface, loopback a copy */
    147  1.2     onoe 		if ((m0->m_flags & M_BCAST) && (ifp->if_flags & IFF_SIMPLEX))
    148  1.2     onoe 			mcopy = m_copy(m0, 0, M_COPYALL);
    149  1.1     onoe 		etype = htons(ETHERTYPE_IP);
    150  1.1     onoe 		break;
    151  1.1     onoe 	case AF_ARP:
    152  1.2     onoe 		ah = mtod(m0, struct ieee1394_arphdr *);
    153  1.1     onoe 		memcpy(&hwdst, ifp->if_broadcastaddr, sizeof(hwdst));
    154  1.1     onoe 		etype = htons(ETHERTYPE_ARP);
    155  1.1     onoe 		break;
    156  1.1     onoe #endif /* INET */
    157  1.1     onoe #ifdef INET6
    158  1.1     onoe 	case AF_INET6:
    159  1.2     onoe 		if (m0->m_flags & M_MCAST)
    160  1.1     onoe 			memcpy(&hwdst, ifp->if_broadcastaddr, sizeof(hwdst));
    161  1.2     onoe 		else if (!nd6_storelladdr(ifp, rt, m0, dst, (u_char *)&hwdst)) {
    162  1.1     onoe 			/* this must be impossible, so we bark */
    163  1.1     onoe 			printf("ieee1394_output: nd6_storelladdr failed\n");
    164  1.1     onoe 			return 0;
    165  1.1     onoe 		}
    166  1.1     onoe 		etype = htons(ETHERTYPE_IPV6);
    167  1.1     onoe 		break;
    168  1.1     onoe #endif /* INET6 */
    169  1.1     onoe 
    170  1.1     onoe 	case pseudo_AF_HDRCMPLT:
    171  1.1     onoe 	case AF_UNSPEC:
    172  1.1     onoe 		/* TODO? */
    173  1.1     onoe 	default:
    174  1.1     onoe 		printf("%s: can't handle af%d\n", ifp->if_xname,
    175  1.1     onoe 		    dst->sa_family);
    176  1.1     onoe 		senderr(EAFNOSUPPORT);
    177  1.1     onoe 		break;
    178  1.1     onoe 	}
    179  1.1     onoe 
    180  1.1     onoe 	if (mcopy)
    181  1.1     onoe 		looutput(ifp, mcopy, dst, rt);
    182  1.1     onoe #if NBPFILTER > 0
    183  1.2     onoe 	/* XXX: emulate DLT_EN10MB */
    184  1.1     onoe 	if (ifp->if_bpf) {
    185  1.1     onoe 		struct mbuf mb;
    186  1.1     onoe 
    187  1.2     onoe 		mb.m_next = m0;
    188  1.1     onoe 		mb.m_len = 14;
    189  1.1     onoe 		mb.m_data = mb.m_dat;
    190  1.1     onoe 		((u_int32_t *)mb.m_data)[0] = 0;
    191  1.1     onoe 		((u_int32_t *)mb.m_data)[1] = 0;
    192  1.1     onoe 		((u_int32_t *)mb.m_data)[2] = 0;
    193  1.1     onoe 		((u_int16_t *)mb.m_data)[6] = etype;
    194  1.1     onoe 		bpf_mtap(ifp->if_bpf, &mb);
    195  1.1     onoe 	}
    196  1.1     onoe #endif
    197  1.2     onoe 	myaddr = (struct ieee1394_hwaddr *)LLADDR(ifp->if_sadl);
    198  1.2     onoe 	if ((ifp->if_flags & IFF_SIMPLEX) &&
    199  1.2     onoe 	    memcmp(&hwdst, myaddr, IEEE1394_ADDR_LEN) == 0)
    200  1.2     onoe 		return looutput(ifp, m0, dst, rt);
    201  1.2     onoe 
    202  1.3     onoe 	/*
    203  1.3     onoe 	 * XXX:
    204  1.3     onoe 	 * The maximum possible rate depends on the topology.
    205  1.3     onoe 	 * So the determination of maxrec and fragmentation should be
    206  1.3     onoe 	 * called from the driver after probing the topology map.
    207  1.3     onoe 	 */
    208  1.2     onoe 	if (m0->m_flags & (M_BCAST | M_MCAST)) {
    209  1.2     onoe 		hdrlen = IEEE1394_GASP_LEN;
    210  1.3     onoe 		hwdst.iha_speed = 0;	/* XXX */
    211  1.2     onoe 	} else
    212  1.2     onoe 		hdrlen = 0;
    213  1.2     onoe 	if (hwdst.iha_speed > myaddr->iha_speed)
    214  1.2     onoe 		hwdst.iha_speed = myaddr->iha_speed;
    215  1.2     onoe 	if (hwdst.iha_maxrec > myaddr->iha_maxrec)
    216  1.2     onoe 		hwdst.iha_maxrec = myaddr->iha_maxrec;
    217  1.2     onoe 	if (hwdst.iha_maxrec > (8 + hwdst.iha_speed))
    218  1.2     onoe 		hwdst.iha_maxrec = 8 + hwdst.iha_speed;
    219  1.2     onoe 	if (hwdst.iha_maxrec < 8)
    220  1.2     onoe 		hwdst.iha_maxrec = 8;
    221  1.1     onoe 
    222  1.2     onoe 	m0 = ieee1394_fragment(ifp, m0, (2<<hwdst.iha_maxrec) - hdrlen, etype);
    223  1.2     onoe 	if (m0 == NULL)
    224  1.2     onoe 		senderr(ENOBUFS);
    225  1.3     onoe 
    226  1.1     onoe 	s = splimp();
    227  1.1     onoe 	if (IF_QFULL(&ifp->if_snd)) {
    228  1.1     onoe 		IF_DROP(&ifp->if_snd);
    229  1.1     onoe 		splx(s);
    230  1.1     onoe 		senderr(ENOBUFS);
    231  1.1     onoe 	}
    232  1.2     onoe 	ifp->if_obytes += m0->m_pkthdr.len;
    233  1.1     onoe 	if (m0->m_flags & M_MCAST)
    234  1.1     onoe 		ifp->if_omcasts++;
    235  1.2     onoe 	while ((m = m0) != NULL) {
    236  1.2     onoe 		m0 = m->m_nextpkt;
    237  1.2     onoe 		M_PREPEND(m, sizeof(struct ieee1394_header), M_DONTWAIT);
    238  1.2     onoe 		if (m == NULL) {
    239  1.2     onoe 			splx(s);
    240  1.2     onoe 			senderr(ENOBUFS);
    241  1.2     onoe 		}
    242  1.2     onoe 		memcpy(mtod(m, caddr_t), &hwdst, sizeof(hwdst));
    243  1.2     onoe 		IF_ENQUEUE(&ifp->if_snd, m);
    244  1.2     onoe 	}
    245  1.1     onoe 	if ((ifp->if_flags & IFF_OACTIVE) == 0)
    246  1.1     onoe 		(*ifp->if_start)(ifp);
    247  1.1     onoe 	splx(s);
    248  1.2     onoe 	return 0;
    249  1.1     onoe 
    250  1.1     onoe   bad:
    251  1.1     onoe 	while (m0 != NULL) {
    252  1.1     onoe 		m = m0->m_nextpkt;
    253  1.1     onoe 		m_freem(m0);
    254  1.1     onoe 		m0 = m;
    255  1.1     onoe 	}
    256  1.1     onoe 
    257  1.1     onoe 	return error;
    258  1.1     onoe }
    259  1.1     onoe 
    260  1.2     onoe struct mbuf *
    261  1.2     onoe ieee1394_fragment(struct ifnet *ifp, struct mbuf *m0, int maxsize,
    262  1.2     onoe     u_int16_t etype)
    263  1.2     onoe {
    264  1.2     onoe 	struct ieee1394com *ic = (struct ieee1394com *)ifp;
    265  1.2     onoe 	int totlen, fraglen, off;
    266  1.2     onoe 	struct mbuf *m, **mp;
    267  1.2     onoe 	struct ieee1394_fraghdr *ifh;
    268  1.2     onoe 	struct ieee1394_unfraghdr *iuh;
    269  1.2     onoe 
    270  1.2     onoe 	totlen = m0->m_pkthdr.len;
    271  1.2     onoe 	if (totlen + sizeof(struct ieee1394_unfraghdr) <= maxsize) {
    272  1.2     onoe 		M_PREPEND(m0, sizeof(struct ieee1394_unfraghdr), M_DONTWAIT);
    273  1.2     onoe 		if (m0 == NULL)
    274  1.2     onoe 			goto bad;
    275  1.2     onoe 		iuh = mtod(m0, struct ieee1394_unfraghdr *);
    276  1.2     onoe 		iuh->iuh_ft = 0;
    277  1.2     onoe 		iuh->iuh_etype = etype;
    278  1.2     onoe 		return m0;
    279  1.2     onoe 	}
    280  1.2     onoe 
    281  1.2     onoe 	fraglen = maxsize - sizeof(struct ieee1394_fraghdr);
    282  1.2     onoe 
    283  1.2     onoe 	M_PREPEND(m0, sizeof(struct ieee1394_fraghdr), M_DONTWAIT);
    284  1.2     onoe 	if (m0 == NULL)
    285  1.2     onoe 		goto bad;
    286  1.2     onoe 	ifh = mtod(m0, struct ieee1394_fraghdr *);
    287  1.2     onoe 	ifh->ifh_ft_size = htons(IEEE1394_FT_MORE | (totlen - 1));
    288  1.2     onoe 	ifh->ifh_etype_off = etype;
    289  1.2     onoe 	ifh->ifh_dgl = htons(ic->ic_dgl);
    290  1.2     onoe 	ifh->ifh_reserved = 0;
    291  1.2     onoe 	off = fraglen;
    292  1.2     onoe 	mp = &m0->m_nextpkt;
    293  1.2     onoe 	while (off < totlen) {
    294  1.2     onoe 		if (off + fraglen > totlen)
    295  1.2     onoe 			fraglen = totlen - off;
    296  1.2     onoe 		MGETHDR(m, M_DONTWAIT, MT_HEADER);
    297  1.2     onoe 		if (m == NULL)
    298  1.2     onoe 			goto bad;
    299  1.2     onoe 		m->m_flags |= m0->m_flags & (M_BCAST|M_MCAST);	/* copy bcast */
    300  1.2     onoe 		MH_ALIGN(m, sizeof(struct ieee1394_fraghdr));
    301  1.2     onoe 		m->m_len = sizeof(struct ieee1394_fraghdr);
    302  1.2     onoe 		ifh = mtod(m, struct ieee1394_fraghdr *);
    303  1.2     onoe 		ifh->ifh_ft_size =
    304  1.2     onoe 		    htons(IEEE1394_FT_SUBSEQ | IEEE1394_FT_MORE | (totlen - 1));
    305  1.2     onoe 		ifh->ifh_etype_off = htons(off);
    306  1.2     onoe 		ifh->ifh_dgl = htons(ic->ic_dgl);
    307  1.2     onoe 		ifh->ifh_reserved = 0;
    308  1.3     onoe 		m->m_next = m_copy(m0, sizeof(*ifh) + off, fraglen);
    309  1.2     onoe 		if (m->m_next == NULL)
    310  1.2     onoe 			goto bad;
    311  1.3     onoe 		m->m_pkthdr.len = sizeof(*ifh) + fraglen;
    312  1.2     onoe 		off += fraglen;
    313  1.2     onoe 		*mp = m;
    314  1.2     onoe 		mp = &m->m_nextpkt;
    315  1.2     onoe 	}
    316  1.2     onoe 	ifh->ifh_ft_size &= ~htons(IEEE1394_FT_MORE);	/* last fragment */
    317  1.2     onoe 	m_adj(m0, -(m0->m_pkthdr.len - maxsize));
    318  1.2     onoe 
    319  1.2     onoe 	ic->ic_dgl++;
    320  1.2     onoe 	return m0;
    321  1.2     onoe 
    322  1.2     onoe   bad:
    323  1.2     onoe 	while ((m = m0) != NULL) {
    324  1.2     onoe 		m0 = m->m_nextpkt;
    325  1.2     onoe 		m->m_nextpkt = NULL;
    326  1.2     onoe 		m_freem(m);
    327  1.2     onoe 	}
    328  1.2     onoe 	return NULL;
    329  1.2     onoe }
    330  1.2     onoe 
    331  1.1     onoe static void
    332  1.1     onoe ieee1394_input(struct ifnet *ifp, struct mbuf *m)
    333  1.1     onoe {
    334  1.1     onoe 	struct ifqueue *inq;
    335  1.1     onoe 	u_int16_t etype;
    336  1.1     onoe 	int s;
    337  1.2     onoe 	struct ieee1394_header *ih;
    338  1.1     onoe 	struct ieee1394_unfraghdr *iuh;
    339  1.1     onoe 
    340  1.1     onoe 	if ((ifp->if_flags & IFF_UP) == 0) {
    341  1.1     onoe 		m_freem(m);
    342  1.1     onoe 		return;
    343  1.1     onoe 	}
    344  1.2     onoe 	if (m->m_len < sizeof(*ih) + sizeof(*iuh)) {
    345  1.3     onoe 		if ((m = m_pullup(m, sizeof(*ih) + sizeof(*iuh))) == NULL)
    346  1.2     onoe 			return;
    347  1.2     onoe 	}
    348  1.1     onoe 
    349  1.2     onoe 	ih = mtod(m, struct ieee1394_header *);
    350  1.2     onoe 	iuh = (struct ieee1394_unfraghdr *)&ih[1];
    351  1.2     onoe 
    352  1.2     onoe 	if (ntohs(iuh->iuh_ft) & (IEEE1394_FT_SUBSEQ | IEEE1394_FT_MORE)) {
    353  1.3     onoe 		if ((m = ieee1394_reass(ifp, m)) == NULL)
    354  1.2     onoe 			return;
    355  1.2     onoe 		ih = mtod(m, struct ieee1394_header *);
    356  1.2     onoe 		iuh = (struct ieee1394_unfraghdr *)&ih[1];
    357  1.1     onoe 	}
    358  1.1     onoe 	etype = ntohs(iuh->iuh_etype);
    359  1.1     onoe 
    360  1.1     onoe 	/* strip off the ieee1394 header */
    361  1.3     onoe 	m_adj(m, sizeof(*ih) + sizeof(*iuh));
    362  1.1     onoe #if NBPFILTER > 0
    363  1.2     onoe 	/* XXX: emulate DLT_EN10MB */
    364  1.1     onoe 	if (ifp->if_bpf) {
    365  1.1     onoe 		struct mbuf mb;
    366  1.1     onoe 
    367  1.1     onoe 		mb.m_next = m;
    368  1.1     onoe 		mb.m_len = 14;
    369  1.1     onoe 		mb.m_data = mb.m_dat;
    370  1.1     onoe 		((u_int32_t *)mb.m_data)[0] = 0;
    371  1.1     onoe 		((u_int32_t *)mb.m_data)[1] = 0;
    372  1.1     onoe 		((u_int32_t *)mb.m_data)[2] = 0;
    373  1.1     onoe 		((u_int16_t *)mb.m_data)[6] = iuh->iuh_etype;
    374  1.1     onoe 		bpf_mtap(ifp->if_bpf, &mb);
    375  1.1     onoe 	}
    376  1.1     onoe #endif
    377  1.1     onoe 
    378  1.1     onoe 	switch (etype) {
    379  1.1     onoe #ifdef INET
    380  1.1     onoe 	case ETHERTYPE_IP:
    381  1.1     onoe 		schednetisr(NETISR_IP);
    382  1.1     onoe 		inq = &ipintrq;
    383  1.1     onoe 		break;
    384  1.1     onoe 
    385  1.1     onoe 	case ETHERTYPE_ARP:
    386  1.1     onoe 		in_ieee1394arpinput(m);
    387  1.1     onoe 		return;
    388  1.1     onoe #endif /* INET */
    389  1.1     onoe 
    390  1.1     onoe #ifdef INET6
    391  1.1     onoe 	case ETHERTYPE_IPV6:
    392  1.1     onoe 		schednetisr(NETISR_IPV6);
    393  1.1     onoe 		inq = &ip6intrq;
    394  1.1     onoe 		break;
    395  1.1     onoe #endif /* INET6 */
    396  1.1     onoe 
    397  1.1     onoe 	default:
    398  1.1     onoe 		m_freem(m);
    399  1.1     onoe 		return;
    400  1.1     onoe 	}
    401  1.1     onoe 
    402  1.1     onoe 	s = splimp();
    403  1.1     onoe 	if (IF_QFULL(inq)) {
    404  1.1     onoe 		IF_DROP(inq);
    405  1.1     onoe 		m_freem(m);
    406  1.1     onoe 	} else
    407  1.1     onoe 		IF_ENQUEUE(inq, m);
    408  1.1     onoe 	splx(s);
    409  1.1     onoe }
    410  1.1     onoe 
    411  1.2     onoe static struct mbuf *
    412  1.2     onoe ieee1394_reass(struct ifnet *ifp, struct mbuf *m0)
    413  1.2     onoe {
    414  1.2     onoe 	struct ieee1394com *ic = (struct ieee1394com *)ifp;
    415  1.2     onoe 	struct ieee1394_header *ih;
    416  1.2     onoe 	struct ieee1394_fraghdr *ifh;
    417  1.2     onoe 	struct ieee1394_unfraghdr *iuh;
    418  1.2     onoe 	struct ieee1394_reassq *rq;
    419  1.2     onoe 	struct ieee1394_reass_pkt *rp, *trp, *nrp;
    420  1.2     onoe 	int len;
    421  1.2     onoe 	u_int16_t off, ftype, size, dgl;
    422  1.2     onoe 
    423  1.2     onoe 	if (m0->m_len < sizeof(*ih) + sizeof(*ifh)) {
    424  1.3     onoe 		if ((m0 = m_pullup(m0, sizeof(*ih) + sizeof(*ifh))) == NULL)
    425  1.2     onoe 			return NULL;
    426  1.2     onoe 	}
    427  1.2     onoe 	ih = mtod(m0, struct ieee1394_header *);
    428  1.2     onoe 	ifh = (struct ieee1394_fraghdr *)&ih[1];
    429  1.2     onoe 	m_adj(m0, sizeof(*ih) + sizeof(*ifh));
    430  1.2     onoe 	size = ntohs(ifh->ifh_ft_size);
    431  1.2     onoe 	ftype = size & (IEEE1394_FT_SUBSEQ | IEEE1394_FT_MORE);
    432  1.2     onoe 	size = (size & ~ftype) + 1;
    433  1.2     onoe 	dgl = ifh->ifh_dgl;
    434  1.2     onoe 	len = m0->m_pkthdr.len;
    435  1.2     onoe 	if (ftype & IEEE1394_FT_SUBSEQ) {
    436  1.2     onoe 		m0->m_flags &= ~M_PKTHDR;
    437  1.2     onoe 		off = ntohs(ifh->ifh_etype_off);
    438  1.2     onoe 	} else
    439  1.2     onoe 		off = 0;
    440  1.2     onoe 
    441  1.2     onoe 	for (rq = LIST_FIRST(&ic->ic_reassq); ; rq = LIST_NEXT(rq, rq_node)) {
    442  1.2     onoe 		if (rq == NULL) {
    443  1.2     onoe 			/*
    444  1.2     onoe 			 * Create a new reassemble queue head for the node.
    445  1.2     onoe 			 */
    446  1.2     onoe 			rq = malloc(sizeof(*rq), M_FTABLE, M_NOWAIT);
    447  1.2     onoe 			if (rq == NULL) {
    448  1.2     onoe 				m_freem(m0);
    449  1.2     onoe 				return NULL;
    450  1.2     onoe 			}
    451  1.2     onoe 			memcpy(rq->rq_uid, ih->ih_uid, IEEE1394_ADDR_LEN);
    452  1.2     onoe 			LIST_INIT(&rq->rq_pkt);
    453  1.2     onoe 			LIST_INSERT_HEAD(&ic->ic_reassq, rq, rq_node);
    454  1.2     onoe 			break;
    455  1.2     onoe 		}
    456  1.2     onoe 		if (memcmp(rq->rq_uid, ih->ih_uid, IEEE1394_ADDR_LEN) == 0)
    457  1.2     onoe 			break;
    458  1.2     onoe 	}
    459  1.2     onoe 	for (rp = LIST_FIRST(&rq->rq_pkt); rp != NULL; rp = nrp) {
    460  1.2     onoe 		nrp = LIST_NEXT(rp, rp_next);
    461  1.2     onoe 		if (rp->rp_dgl != dgl)
    462  1.2     onoe 			continue;
    463  1.3     onoe 		/*
    464  1.3     onoe 		 * sanity check:
    465  1.3     onoe 		 * datagram size must be same for all fragments, and
    466  1.3     onoe 		 * no overlap is allowed.
    467  1.3     onoe 		 */
    468  1.3     onoe 		if (rp->rp_size != size ||
    469  1.3     onoe 		    (off < rp->rp_off + rp->rp_len && off + len > rp->rp_off)) {
    470  1.2     onoe 			/*
    471  1.3     onoe 			 * This happens probably due to wrapping dgl value.
    472  1.3     onoe 			 * Destroy all previously received fragment and
    473  1.3     onoe 			 * enqueue current fragment.
    474  1.2     onoe 			 */
    475  1.3     onoe 			for (rp = LIST_FIRST(&rq->rq_pkt); rp != NULL;
    476  1.3     onoe 			    rp = nrp) {
    477  1.3     onoe 				nrp = LIST_NEXT(rp, rp_next);
    478  1.3     onoe 				if (rp->rp_dgl == dgl) {
    479  1.3     onoe 					LIST_REMOVE(rp, rp_next);
    480  1.3     onoe 					m_freem(rp->rp_m);
    481  1.3     onoe 					free(rp, M_FTABLE);
    482  1.3     onoe 				}
    483  1.3     onoe 			}
    484  1.3     onoe 			break;
    485  1.2     onoe 		}
    486  1.2     onoe 		if (rp->rp_off + rp->rp_len == off) {
    487  1.2     onoe 			/*
    488  1.2     onoe 			 * All the subsequent fragments received in sequence
    489  1.2     onoe 			 * come here.
    490  1.2     onoe 			 * Concatinate mbuf to previous one instead of
    491  1.2     onoe 			 * allocating new reassemble queue structure,
    492  1.2     onoe 			 * and try to merge more with the subsequent fragment
    493  1.2     onoe 			 * in the queue.
    494  1.2     onoe 			 */
    495  1.2     onoe 			m_cat(rp->rp_m, m0);
    496  1.2     onoe 			rp->rp_len += len;
    497  1.2     onoe 			while (rp->rp_off + rp->rp_len < size &&
    498  1.2     onoe 			    nrp != NULL && nrp->rp_dgl == dgl &&
    499  1.2     onoe 			    nrp->rp_off == rp->rp_off + rp->rp_len) {
    500  1.2     onoe 				LIST_REMOVE(nrp, rp_next);
    501  1.2     onoe 				m_cat(rp->rp_m, nrp->rp_m);
    502  1.2     onoe 				rp->rp_len += nrp->rp_len;
    503  1.3     onoe 				free(nrp, M_FTABLE);
    504  1.2     onoe 				nrp = LIST_NEXT(rp, rp_next);
    505  1.2     onoe 			}
    506  1.2     onoe 			m0 = NULL;	/* mark merged */
    507  1.2     onoe 			break;
    508  1.2     onoe 		}
    509  1.2     onoe 		if (off + m0->m_pkthdr.len == rp->rp_off) {
    510  1.2     onoe 			m_cat(m0, rp->rp_m);
    511  1.2     onoe 			rp->rp_m = m0;
    512  1.2     onoe 			rp->rp_off = off;
    513  1.2     onoe 			rp->rp_len += len;
    514  1.2     onoe 			m0 = NULL;	/* mark merged */
    515  1.2     onoe 			break;
    516  1.2     onoe 		}
    517  1.2     onoe 		if (rp->rp_off > off) {
    518  1.2     onoe 			/* insert before rp */
    519  1.2     onoe 			nrp = rp;
    520  1.2     onoe 			break;
    521  1.2     onoe 		}
    522  1.2     onoe 		if (nrp == NULL || nrp->rp_dgl != dgl) {
    523  1.2     onoe 			/* insert after rp */
    524  1.2     onoe 			nrp = NULL;
    525  1.2     onoe 			break;
    526  1.2     onoe 		}
    527  1.2     onoe 	}
    528  1.2     onoe 	if (m0 == NULL) {
    529  1.2     onoe 		if (rp->rp_off != 0 || rp->rp_len != size)
    530  1.2     onoe 			return NULL;
    531  1.2     onoe 		/* fragment done */
    532  1.2     onoe 		LIST_REMOVE(rp, rp_next);
    533  1.2     onoe 		m0 = rp->rp_m;
    534  1.2     onoe 		m0->m_pkthdr.len = rp->rp_len;
    535  1.2     onoe 		M_PREPEND(m0, sizeof(*ih) + sizeof(*iuh), M_DONTWAIT);
    536  1.2     onoe 		if (m0 != NULL) {
    537  1.2     onoe 			ih = mtod(m0, struct ieee1394_header *);
    538  1.2     onoe 			iuh = (struct ieee1394_unfraghdr *)&ih[1];
    539  1.2     onoe 			memcpy(ih, &rp->rp_hdr, sizeof(*ih));
    540  1.2     onoe 			iuh->iuh_ft = 0;
    541  1.2     onoe 			iuh->iuh_etype = rp->rp_etype;
    542  1.2     onoe 		}
    543  1.2     onoe 		free(rp, M_FTABLE);
    544  1.2     onoe 		return m0;
    545  1.2     onoe 	}
    546  1.2     onoe 
    547  1.2     onoe 	/*
    548  1.2     onoe 	 * New fragment received.  Allocate reassemble queue structure.
    549  1.2     onoe 	 */
    550  1.2     onoe 	trp = malloc(sizeof(*trp), M_FTABLE, M_NOWAIT);
    551  1.2     onoe 	if (trp == NULL) {
    552  1.2     onoe 		m_freem(m0);
    553  1.2     onoe 		return NULL;
    554  1.2     onoe 	}
    555  1.2     onoe 	trp->rp_m = m0;
    556  1.2     onoe 	memcpy(&trp->rp_hdr, ih, sizeof(*ih));
    557  1.2     onoe 	trp->rp_size = size;
    558  1.2     onoe 	trp->rp_etype = ifh->ifh_etype_off;	 /* valid only if off==0 */
    559  1.2     onoe 	trp->rp_off = off;
    560  1.2     onoe 	trp->rp_dgl = dgl;
    561  1.2     onoe 	trp->rp_len = len;
    562  1.3     onoe 	trp->rp_ttl = IEEE1394_REASS_TIMEOUT;
    563  1.3     onoe 	if (trp->rp_ttl <= ifp->if_timer)
    564  1.3     onoe 		trp->rp_ttl = ifp->if_timer + 1;
    565  1.2     onoe 
    566  1.2     onoe 	if (rp == NULL) {
    567  1.2     onoe 		/* first fragment for the dgl */
    568  1.2     onoe 		LIST_INSERT_HEAD(&rq->rq_pkt, trp, rp_next);
    569  1.2     onoe 	} else if (nrp == NULL) {
    570  1.2     onoe 		/* no next fragment for the dgl */
    571  1.2     onoe 		LIST_INSERT_AFTER(rp, trp, rp_next);
    572  1.2     onoe 	} else {
    573  1.2     onoe 		/* there is a hole */
    574  1.2     onoe 		LIST_INSERT_BEFORE(nrp, trp, rp_next);
    575  1.2     onoe 	}
    576  1.2     onoe 	return NULL;
    577  1.2     onoe }
    578  1.2     onoe 
    579  1.3     onoe void
    580  1.3     onoe ieee1394_drain(struct ifnet *ifp)
    581  1.3     onoe {
    582  1.3     onoe 	struct ieee1394com *ic = (struct ieee1394com *)ifp;
    583  1.3     onoe 	struct ieee1394_reassq *rq;
    584  1.3     onoe 	struct ieee1394_reass_pkt *rp;
    585  1.3     onoe 
    586  1.3     onoe 	while ((rq = LIST_FIRST(&ic->ic_reassq)) != NULL) {
    587  1.3     onoe 		LIST_REMOVE(rq, rq_node);
    588  1.3     onoe 		while ((rp = LIST_FIRST(&rq->rq_pkt)) != NULL) {
    589  1.3     onoe 			LIST_REMOVE(rp, rp_next);
    590  1.3     onoe 			m_freem(rp->rp_m);
    591  1.3     onoe 			free(rp, M_FTABLE);
    592  1.3     onoe 		}
    593  1.3     onoe 		free(rq, M_FTABLE);
    594  1.3     onoe 	}
    595  1.3     onoe }
    596  1.3     onoe 
    597  1.3     onoe void
    598  1.3     onoe ieee1394_watchdog(struct ifnet *ifp)
    599  1.3     onoe {
    600  1.3     onoe 	struct ieee1394com *ic = (struct ieee1394com *)ifp;
    601  1.3     onoe 	struct ieee1394_reassq *rq;
    602  1.3     onoe 	struct ieee1394_reass_pkt *rp, *nrp;
    603  1.3     onoe 	int dec;
    604  1.3     onoe 
    605  1.3     onoe 	dec = (ifp->if_timer > 0) ? ifp->if_timer : 1;
    606  1.3     onoe 	for (rq = LIST_FIRST(&ic->ic_reassq); rq != NULL;
    607  1.3     onoe 	    rq = LIST_NEXT(rq, rq_node)) {
    608  1.3     onoe 		for (rp = LIST_FIRST(&rq->rq_pkt); rp != NULL; rp = nrp) {
    609  1.3     onoe 			nrp = LIST_NEXT(rp, rp_next);
    610  1.3     onoe 			if (rp->rp_ttl >= dec)
    611  1.3     onoe 				rp->rp_ttl -= dec;
    612  1.3     onoe 			else {
    613  1.3     onoe 				LIST_REMOVE(rp, rp_next);
    614  1.3     onoe 				m_freem(rp->rp_m);
    615  1.3     onoe 				free(rp, M_FTABLE);
    616  1.3     onoe 			}
    617  1.3     onoe 		}
    618  1.3     onoe 	}
    619  1.3     onoe }
    620  1.3     onoe 
    621  1.1     onoe const char *
    622  1.1     onoe ieee1394_sprintf(const u_int8_t *laddr)
    623  1.1     onoe {
    624  1.1     onoe 	static char buf[3*8];
    625  1.1     onoe 
    626  1.1     onoe 	snprintf(buf, sizeof(buf), "%02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x",
    627  1.1     onoe 	    laddr[0], laddr[1], laddr[2], laddr[3],
    628  1.1     onoe 	    laddr[4], laddr[5], laddr[6], laddr[7]);
    629  1.1     onoe 	return buf;
    630  1.1     onoe }
    631  1.1     onoe 
    632  1.1     onoe void
    633  1.1     onoe ieee1394_ifattach(struct ifnet *ifp, const struct ieee1394_hwaddr *hwaddr)
    634  1.1     onoe {
    635  1.1     onoe 	struct sockaddr_dl *sdl;
    636  1.2     onoe 	struct ieee1394_hwaddr *baddr;
    637  1.2     onoe 	struct ieee1394com *ic = (struct ieee1394com *)ifp;
    638  1.1     onoe 
    639  1.1     onoe 	ifp->if_type = IFT_IEEE1394;
    640  1.1     onoe 	ifp->if_addrlen = sizeof(struct ieee1394_hwaddr);
    641  1.1     onoe 	ifp->if_hdrlen = sizeof(struct ieee1394_header);
    642  1.1     onoe 	ifp->if_mtu = IEEE1394MTU;
    643  1.1     onoe 	ifp->if_output = ieee1394_output;
    644  1.1     onoe 	ifp->if_input = ieee1394_input;
    645  1.3     onoe 	ifp->if_drain = ieee1394_drain;
    646  1.3     onoe 	ifp->if_watchdog = ieee1394_watchdog;
    647  1.3     onoe 	ifp->if_timer = 1;
    648  1.1     onoe 	if (ifp->if_baudrate == 0)
    649  1.1     onoe 		ifp->if_baudrate = IF_Mbps(100);
    650  1.1     onoe 	if ((sdl = ifp->if_sadl) && sdl->sdl_family == AF_LINK) {
    651  1.1     onoe 		sdl->sdl_type = ifp->if_type;
    652  1.1     onoe 		sdl->sdl_alen = ifp->if_addrlen;
    653  1.1     onoe 		memcpy(LLADDR(sdl), hwaddr, ifp->if_addrlen);
    654  1.1     onoe 	}
    655  1.1     onoe 	ifp->if_broadcastaddr = malloc(ifp->if_addrlen, M_DEVBUF, M_WAITOK);
    656  1.2     onoe 	baddr = (struct ieee1394_hwaddr *)ifp->if_broadcastaddr;
    657  1.2     onoe 	memset(baddr->iha_uid, 0xff, IEEE1394_ADDR_LEN);
    658  1.3     onoe 	baddr->iha_speed = 0;	/*XXX: how to determine the speed for bcast? */
    659  1.2     onoe 	baddr->iha_maxrec = 512 << baddr->iha_speed;
    660  1.2     onoe 	memset(baddr->iha_offset, 0, sizeof(baddr->iha_offset));
    661  1.2     onoe 	LIST_INIT(&ic->ic_reassq);
    662  1.4  thorpej #if NBPFILTER > 0
    663  1.4  thorpej 	bpfattach(ifp, DLT_EN10MB, 14);	/* XXX */
    664  1.4  thorpej #endif
    665  1.1     onoe }
    666  1.1     onoe 
    667  1.1     onoe void
    668  1.1     onoe ieee1394_ifdetach(struct ifnet *ifp)
    669  1.1     onoe {
    670  1.1     onoe 	struct sockaddr_dl *sdl = ifp->if_sadl;
    671  1.1     onoe 
    672  1.3     onoe 	ieee1394_drain(ifp);
    673  1.1     onoe 	free(ifp->if_broadcastaddr, M_DEVBUF);
    674  1.1     onoe 	ifp->if_broadcastaddr = NULL;
    675  1.1     onoe 	memset(LLADDR(sdl), 0, sizeof(struct ieee1394_hwaddr));
    676  1.1     onoe 	sdl->sdl_alen = 0;
    677  1.1     onoe 	sdl->sdl_type = 0;
    678  1.4  thorpej #if NBPFILTER > 0
    679  1.4  thorpej 	bpfdetach(ifp);
    680  1.4  thorpej #endif
    681  1.1     onoe }
    682  1.1     onoe 
    683  1.1     onoe int
    684  1.1     onoe ieee1394_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data)
    685  1.1     onoe {
    686  1.1     onoe 	struct ifreq *ifr = (struct ifreq *)data;
    687  1.1     onoe 	struct ifaddr *ifa = (struct ifaddr *)data;
    688  1.1     onoe 	int error = 0;
    689  1.1     onoe #if __NetBSD_Version < 105080000
    690  1.1     onoe 	int fw_init(struct ifnet *);
    691  1.1     onoe 	void fw_stop(struct ifnet *, int);
    692  1.1     onoe #endif
    693  1.1     onoe 
    694  1.1     onoe 	switch (cmd) {
    695  1.1     onoe 	case SIOCSIFADDR:
    696  1.1     onoe 		ifp->if_flags |= IFF_UP;
    697  1.1     onoe 		switch (ifa->ifa_addr->sa_family) {
    698  1.1     onoe #ifdef INET
    699  1.1     onoe 		case AF_INET:
    700  1.1     onoe #if __NetBSD_Version >= 105080000
    701  1.1     onoe 			if ((error = (*ifp->if_init)(ifp)) != 0)
    702  1.1     onoe #else
    703  1.1     onoe 			if ((error = fw_init(ifp)) != 0)
    704  1.1     onoe #endif
    705  1.1     onoe 				break;
    706  1.1     onoe 			ieee1394arp_ifinit(ifp, ifa);
    707  1.1     onoe 			break;
    708  1.1     onoe #endif /* INET */
    709  1.1     onoe 		default:
    710  1.1     onoe #if __NetBSD_Version >= 105080000
    711  1.1     onoe 			error = (*ifp->if_init)(ifp);
    712  1.1     onoe #else
    713  1.1     onoe 			error = fw_init(ifp);
    714  1.1     onoe #endif
    715  1.1     onoe 			break;
    716  1.1     onoe 		}
    717  1.1     onoe 		break;
    718  1.1     onoe 
    719  1.1     onoe 	case SIOCGIFADDR:
    720  1.1     onoe 		memcpy(((struct sockaddr *)&ifr->ifr_data)->sa_data,
    721  1.1     onoe 		    LLADDR(ifp->if_sadl), IEEE1394_ADDR_LEN);
    722  1.1     onoe 		    break;
    723  1.1     onoe 
    724  1.1     onoe 	case SIOCSIFMTU:
    725  1.1     onoe 		if (ifr->ifr_mtu > IEEE1394MTU)
    726  1.1     onoe 			error = EINVAL;
    727  1.1     onoe 		else
    728  1.1     onoe 			ifp->if_mtu = ifr->ifr_mtu;
    729  1.1     onoe 		break;
    730  1.1     onoe 
    731  1.1     onoe 	case SIOCSIFFLAGS:
    732  1.1     onoe #if __NetBSD_Version >= 105080000
    733  1.1     onoe 		if ((ifp->if_flags & (IFF_UP|IFF_RUNNING)) == IFF_RUNNING)
    734  1.1     onoe 			(*ifp->if_stop)(ifp, 1);
    735  1.1     onoe 		else if ((ifp->if_flags & (IFF_UP|IFF_RUNNING)) == IFF_UP)
    736  1.1     onoe 			error = (*ifp->if_init)(ifp);
    737  1.1     onoe 		else if ((ifp->if_flags & IFF_UP) != 0)
    738  1.1     onoe 			error = (*ifp->if_init)(ifp);
    739  1.1     onoe #else
    740  1.1     onoe 		if ((ifp->if_flags & (IFF_UP|IFF_RUNNING)) == IFF_RUNNING)
    741  1.1     onoe 			fw_stop(ifp, 1);
    742  1.1     onoe 		else if ((ifp->if_flags & (IFF_UP|IFF_RUNNING)) == IFF_UP)
    743  1.1     onoe 			error = fw_init(ifp);
    744  1.1     onoe 		else if ((ifp->if_flags & IFF_UP) != 0)
    745  1.1     onoe 			error = fw_init(ifp);
    746  1.1     onoe #endif
    747  1.1     onoe 		break;
    748  1.1     onoe 
    749  1.1     onoe 	case SIOCADDMULTI:
    750  1.1     onoe 	case SIOCDELMULTI:
    751  1.1     onoe 		/* nothing to do */
    752  1.1     onoe 		break;
    753  1.1     onoe 
    754  1.1     onoe 	default:
    755  1.1     onoe 		error = ENOTTY;
    756  1.1     onoe 		break;
    757  1.1     onoe 	}
    758  1.1     onoe 
    759  1.1     onoe 	return error;
    760  1.1     onoe }
    761