Home | History | Annotate | Line # | Download | only in net
if_ieee1394subr.c revision 1.55
      1  1.55  knakahar /*	$NetBSD: if_ieee1394subr.c,v 1.55 2016/04/28 01:37:17 knakahara 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  *
     19   1.1      onoe  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20   1.1      onoe  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21   1.1      onoe  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22   1.1      onoe  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23   1.1      onoe  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24   1.1      onoe  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25   1.1      onoe  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26   1.1      onoe  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27   1.1      onoe  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28   1.1      onoe  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29   1.1      onoe  * POSSIBILITY OF SUCH DAMAGE.
     30   1.1      onoe  */
     31  1.12     lukem 
     32  1.12     lukem #include <sys/cdefs.h>
     33  1.55  knakahar __KERNEL_RCSID(0, "$NetBSD: if_ieee1394subr.c,v 1.55 2016/04/28 01:37:17 knakahara Exp $");
     34   1.1      onoe 
     35  1.50     pooka #ifdef _KERNEL_OPT
     36   1.1      onoe #include "opt_inet.h"
     37  1.50     pooka #endif
     38   1.1      onoe 
     39   1.1      onoe #include <sys/param.h>
     40   1.1      onoe #include <sys/systm.h>
     41  1.43  kiyohara #include <sys/bus.h>
     42  1.43  kiyohara #include <sys/device.h>
     43  1.43  kiyohara #include <sys/kernel.h>
     44  1.43  kiyohara #include <sys/mbuf.h>
     45   1.1      onoe #include <sys/socket.h>
     46   1.1      onoe #include <sys/sockio.h>
     47  1.44  pgoyette #include <sys/select.h>
     48   1.1      onoe 
     49   1.1      onoe #include <net/if.h>
     50   1.1      onoe #include <net/if_dl.h>
     51   1.1      onoe #include <net/if_ieee1394.h>
     52   1.1      onoe #include <net/if_types.h>
     53   1.1      onoe #include <net/if_media.h>
     54   1.1      onoe #include <net/ethertypes.h>
     55   1.1      onoe #include <net/netisr.h>
     56   1.1      onoe #include <net/route.h>
     57   1.1      onoe 
     58   1.1      onoe #include <net/bpf.h>
     59   1.1      onoe 
     60   1.1      onoe #ifdef INET
     61   1.1      onoe #include <netinet/in.h>
     62   1.1      onoe #include <netinet/in_var.h>
     63  1.16    itojun #include <netinet/if_inarp.h>
     64   1.1      onoe #endif /* INET */
     65   1.1      onoe #ifdef INET6
     66   1.1      onoe #include <netinet/in.h>
     67   1.1      onoe #include <netinet6/in6_var.h>
     68   1.1      onoe #include <netinet6/nd6.h>
     69   1.1      onoe #endif /* INET6 */
     70   1.1      onoe 
     71  1.29  kiyohara #include <dev/ieee1394/firewire.h>
     72  1.29  kiyohara 
     73  1.29  kiyohara #include <dev/ieee1394/firewirereg.h>
     74  1.29  kiyohara #include <dev/ieee1394/iec13213.h>
     75  1.29  kiyohara #include <dev/ieee1394/if_fwipvar.h>
     76  1.29  kiyohara 
     77   1.3      onoe #define	IEEE1394_REASS_TIMEOUT	3	/* 3 sec */
     78   1.3      onoe 
     79   1.1      onoe #define	senderr(e)	do { error = (e); goto bad; } while(0/*CONSTCOND*/)
     80   1.1      onoe 
     81  1.33    dyoung static int  ieee1394_output(struct ifnet *, struct mbuf *,
     82  1.54     ozaki 		const struct sockaddr *, const struct rtentry *);
     83  1.39      matt static struct mbuf *ieee1394_reass(struct ifnet *, struct mbuf *, uint16_t);
     84   1.1      onoe 
     85   1.1      onoe static int
     86  1.33    dyoung ieee1394_output(struct ifnet *ifp, struct mbuf *m0, const struct sockaddr *dst,
     87  1.54     ozaki     const struct rtentry *rt)
     88   1.1      onoe {
     89  1.39      matt 	uint16_t etype = 0;
     90   1.2      onoe 	struct mbuf *m;
     91  1.55  knakahar 	int hdrlen, error = 0;
     92   1.1      onoe 	struct mbuf *mcopy = NULL;
     93  1.36    dyoung 	struct ieee1394_hwaddr *hwdst, baddr;
     94  1.36    dyoung 	const struct ieee1394_hwaddr *myaddr;
     95  1.18      onoe #ifdef INET
     96  1.18      onoe 	struct arphdr *ah;
     97  1.18      onoe #endif /* INET */
     98  1.29  kiyohara 	struct m_tag *mtag;
     99  1.29  kiyohara 	int unicast;
    100   1.1      onoe 
    101   1.1      onoe 	if ((ifp->if_flags & (IFF_UP|IFF_RUNNING)) != (IFF_UP|IFF_RUNNING))
    102   1.1      onoe 		senderr(ENETDOWN);
    103  1.14    itojun 
    104  1.14    itojun 	/*
    105  1.14    itojun 	 * If the queueing discipline needs packet classification,
    106  1.14    itojun 	 * do it before prepending link headers.
    107  1.14    itojun 	 */
    108  1.53  knakahar 	IFQ_CLASSIFY(&ifp->if_snd, m0, dst->sa_family);
    109  1.14    itojun 
    110  1.29  kiyohara 	/*
    111  1.29  kiyohara 	 * For unicast, we make a tag to store the lladdr of the
    112  1.29  kiyohara 	 * destination. This might not be the first time we have seen
    113  1.29  kiyohara 	 * the packet (for instance, the arp code might be trying to
    114  1.29  kiyohara 	 * re-send it after receiving an arp reply) so we only
    115  1.29  kiyohara 	 * allocate a tag if there isn't one there already. For
    116  1.29  kiyohara 	 * multicast, we will eventually use a different tag to store
    117  1.29  kiyohara 	 * the channel number.
    118  1.29  kiyohara 	 */
    119  1.29  kiyohara 	unicast = !(m0->m_flags & (M_BCAST | M_MCAST));
    120  1.29  kiyohara 	if (unicast) {
    121  1.29  kiyohara 		mtag =
    122  1.43  kiyohara 		    m_tag_find(m0, MTAG_FIREWIRE_HWADDR, NULL);
    123  1.29  kiyohara 		if (!mtag) {
    124  1.43  kiyohara 			mtag = m_tag_get(MTAG_FIREWIRE_HWADDR,
    125  1.29  kiyohara 			    sizeof (struct ieee1394_hwaddr), M_NOWAIT);
    126  1.29  kiyohara 			if (!mtag) {
    127  1.29  kiyohara 				error = ENOMEM;
    128  1.29  kiyohara 				goto bad;
    129  1.29  kiyohara 			}
    130  1.29  kiyohara 			m_tag_prepend(m0, mtag);
    131  1.29  kiyohara 		}
    132  1.29  kiyohara 		hwdst = (struct ieee1394_hwaddr *)(mtag + 1);
    133  1.29  kiyohara 	} else {
    134  1.29  kiyohara 		hwdst = &baddr;
    135  1.29  kiyohara 	}
    136  1.29  kiyohara 
    137   1.1      onoe 	switch (dst->sa_family) {
    138   1.1      onoe #ifdef INET
    139   1.1      onoe 	case AF_INET:
    140  1.51       roy 		if (unicast &&
    141  1.52  christos 		    (error = arpresolve(ifp, rt, m0, dst, hwdst,
    142  1.52  christos 			sizeof(*hwdst))) != 0)
    143  1.51       roy 			return error == EWOULDBLOCK ? 0 : error;
    144   1.1      onoe 		/* if broadcasting on a simplex interface, loopback a copy */
    145   1.2      onoe 		if ((m0->m_flags & M_BCAST) && (ifp->if_flags & IFF_SIMPLEX))
    146   1.2      onoe 			mcopy = m_copy(m0, 0, M_COPYALL);
    147   1.1      onoe 		etype = htons(ETHERTYPE_IP);
    148   1.1      onoe 		break;
    149   1.1      onoe 	case AF_ARP:
    150  1.18      onoe 		ah = mtod(m0, struct arphdr *);
    151  1.18      onoe 		ah->ar_hrd = htons(ARPHRD_IEEE1394);
    152   1.1      onoe 		etype = htons(ETHERTYPE_ARP);
    153   1.1      onoe 		break;
    154   1.1      onoe #endif /* INET */
    155   1.1      onoe #ifdef INET6
    156   1.1      onoe 	case AF_INET6:
    157  1.33    dyoung 		if (unicast && (!nd6_storelladdr(ifp, rt, m0, dst,
    158  1.33    dyoung 		    hwdst->iha_uid, IEEE1394_ADDR_LEN))) {
    159  1.20    itojun 			/* something bad happened */
    160   1.1      onoe 			return 0;
    161   1.1      onoe 		}
    162   1.1      onoe 		etype = htons(ETHERTYPE_IPV6);
    163   1.1      onoe 		break;
    164   1.1      onoe #endif /* INET6 */
    165   1.1      onoe 
    166   1.1      onoe 	case pseudo_AF_HDRCMPLT:
    167   1.1      onoe 	case AF_UNSPEC:
    168   1.1      onoe 		/* TODO? */
    169   1.1      onoe 	default:
    170   1.1      onoe 		printf("%s: can't handle af%d\n", ifp->if_xname,
    171   1.1      onoe 		    dst->sa_family);
    172   1.1      onoe 		senderr(EAFNOSUPPORT);
    173   1.1      onoe 		break;
    174   1.1      onoe 	}
    175   1.1      onoe 
    176   1.1      onoe 	if (mcopy)
    177   1.1      onoe 		looutput(ifp, mcopy, dst, rt);
    178  1.36    dyoung 	myaddr = (const struct ieee1394_hwaddr *)CLLADDR(ifp->if_sadl);
    179  1.30  kiyohara 	if (ifp->if_bpf) {
    180  1.30  kiyohara 		struct ieee1394_bpfhdr h;
    181  1.30  kiyohara 		if (unicast)
    182  1.30  kiyohara 			memcpy(h.ibh_dhost, hwdst->iha_uid, 8);
    183  1.30  kiyohara 		else
    184  1.30  kiyohara 			memcpy(h.ibh_dhost,
    185  1.30  kiyohara 			    ((const struct ieee1394_hwaddr *)
    186  1.30  kiyohara 			    ifp->if_broadcastaddr)->iha_uid, 8);
    187  1.30  kiyohara 		memcpy(h.ibh_shost, myaddr->iha_uid, 8);
    188  1.30  kiyohara 		h.ibh_type = etype;
    189  1.45     joerg 		bpf_mtap2(ifp->if_bpf, &h, sizeof(h), m0);
    190  1.30  kiyohara 	}
    191   1.2      onoe 	if ((ifp->if_flags & IFF_SIMPLEX) &&
    192  1.29  kiyohara 	    unicast &&
    193  1.29  kiyohara 	    memcmp(hwdst, myaddr, IEEE1394_ADDR_LEN) == 0)
    194   1.2      onoe 		return looutput(ifp, m0, dst, rt);
    195   1.2      onoe 
    196   1.3      onoe 	/*
    197   1.3      onoe 	 * XXX:
    198   1.3      onoe 	 * The maximum possible rate depends on the topology.
    199   1.3      onoe 	 * So the determination of maxrec and fragmentation should be
    200   1.3      onoe 	 * called from the driver after probing the topology map.
    201   1.3      onoe 	 */
    202  1.29  kiyohara 	if (unicast) {
    203   1.2      onoe 		hdrlen = IEEE1394_GASP_LEN;
    204  1.29  kiyohara 		hwdst->iha_speed = 0;	/* XXX */
    205   1.2      onoe 	} else
    206   1.2      onoe 		hdrlen = 0;
    207   1.1      onoe 
    208  1.29  kiyohara 	if (hwdst->iha_speed > myaddr->iha_speed)
    209  1.29  kiyohara 		hwdst->iha_speed = myaddr->iha_speed;
    210  1.29  kiyohara 	if (hwdst->iha_maxrec > myaddr->iha_maxrec)
    211  1.29  kiyohara 		hwdst->iha_maxrec = myaddr->iha_maxrec;
    212  1.29  kiyohara 	if (hwdst->iha_maxrec > (8 + hwdst->iha_speed))
    213  1.29  kiyohara 		hwdst->iha_maxrec = 8 + hwdst->iha_speed;
    214  1.29  kiyohara 	if (hwdst->iha_maxrec < 8)
    215  1.29  kiyohara 			hwdst->iha_maxrec = 8;
    216  1.29  kiyohara 
    217  1.29  kiyohara 	m0 = ieee1394_fragment(ifp, m0, (2<<hwdst->iha_maxrec) - hdrlen, etype);
    218   1.2      onoe 	if (m0 == NULL)
    219   1.2      onoe 		senderr(ENOBUFS);
    220   1.3      onoe 
    221   1.2      onoe 	while ((m = m0) != NULL) {
    222   1.2      onoe 		m0 = m->m_nextpkt;
    223  1.55  knakahar 
    224  1.55  knakahar 		error = (*ifp->if_transmit)(ifp, m);
    225  1.14    itojun 		if (error) {
    226  1.14    itojun 			/* mbuf is already freed */
    227  1.14    itojun 			goto bad;
    228  1.14    itojun 		}
    229   1.2      onoe 	}
    230   1.2      onoe 	return 0;
    231   1.1      onoe 
    232   1.1      onoe   bad:
    233   1.1      onoe 	while (m0 != NULL) {
    234   1.1      onoe 		m = m0->m_nextpkt;
    235   1.1      onoe 		m_freem(m0);
    236   1.1      onoe 		m0 = m;
    237   1.1      onoe 	}
    238   1.1      onoe 
    239   1.1      onoe 	return error;
    240   1.1      onoe }
    241   1.1      onoe 
    242   1.2      onoe struct mbuf *
    243   1.2      onoe ieee1394_fragment(struct ifnet *ifp, struct mbuf *m0, int maxsize,
    244  1.39      matt     uint16_t etype)
    245   1.2      onoe {
    246   1.2      onoe 	struct ieee1394com *ic = (struct ieee1394com *)ifp;
    247   1.2      onoe 	int totlen, fraglen, off;
    248   1.2      onoe 	struct mbuf *m, **mp;
    249   1.2      onoe 	struct ieee1394_fraghdr *ifh;
    250   1.2      onoe 	struct ieee1394_unfraghdr *iuh;
    251   1.2      onoe 
    252   1.2      onoe 	totlen = m0->m_pkthdr.len;
    253   1.2      onoe 	if (totlen + sizeof(struct ieee1394_unfraghdr) <= maxsize) {
    254   1.2      onoe 		M_PREPEND(m0, sizeof(struct ieee1394_unfraghdr), M_DONTWAIT);
    255   1.2      onoe 		if (m0 == NULL)
    256   1.2      onoe 			goto bad;
    257   1.2      onoe 		iuh = mtod(m0, struct ieee1394_unfraghdr *);
    258   1.2      onoe 		iuh->iuh_ft = 0;
    259   1.2      onoe 		iuh->iuh_etype = etype;
    260   1.2      onoe 		return m0;
    261   1.2      onoe 	}
    262   1.2      onoe 
    263   1.2      onoe 	fraglen = maxsize - sizeof(struct ieee1394_fraghdr);
    264   1.2      onoe 
    265   1.2      onoe 	M_PREPEND(m0, sizeof(struct ieee1394_fraghdr), M_DONTWAIT);
    266   1.2      onoe 	if (m0 == NULL)
    267   1.2      onoe 		goto bad;
    268   1.2      onoe 	ifh = mtod(m0, struct ieee1394_fraghdr *);
    269   1.2      onoe 	ifh->ifh_ft_size = htons(IEEE1394_FT_MORE | (totlen - 1));
    270   1.2      onoe 	ifh->ifh_etype_off = etype;
    271   1.2      onoe 	ifh->ifh_dgl = htons(ic->ic_dgl);
    272   1.2      onoe 	ifh->ifh_reserved = 0;
    273   1.2      onoe 	off = fraglen;
    274   1.2      onoe 	mp = &m0->m_nextpkt;
    275   1.2      onoe 	while (off < totlen) {
    276   1.2      onoe 		if (off + fraglen > totlen)
    277   1.2      onoe 			fraglen = totlen - off;
    278   1.2      onoe 		MGETHDR(m, M_DONTWAIT, MT_HEADER);
    279   1.2      onoe 		if (m == NULL)
    280   1.2      onoe 			goto bad;
    281   1.2      onoe 		m->m_flags |= m0->m_flags & (M_BCAST|M_MCAST);	/* copy bcast */
    282   1.2      onoe 		MH_ALIGN(m, sizeof(struct ieee1394_fraghdr));
    283   1.2      onoe 		m->m_len = sizeof(struct ieee1394_fraghdr);
    284   1.2      onoe 		ifh = mtod(m, struct ieee1394_fraghdr *);
    285   1.2      onoe 		ifh->ifh_ft_size =
    286   1.2      onoe 		    htons(IEEE1394_FT_SUBSEQ | IEEE1394_FT_MORE | (totlen - 1));
    287   1.2      onoe 		ifh->ifh_etype_off = htons(off);
    288   1.2      onoe 		ifh->ifh_dgl = htons(ic->ic_dgl);
    289   1.2      onoe 		ifh->ifh_reserved = 0;
    290   1.3      onoe 		m->m_next = m_copy(m0, sizeof(*ifh) + off, fraglen);
    291   1.2      onoe 		if (m->m_next == NULL)
    292   1.2      onoe 			goto bad;
    293   1.3      onoe 		m->m_pkthdr.len = sizeof(*ifh) + fraglen;
    294   1.2      onoe 		off += fraglen;
    295   1.2      onoe 		*mp = m;
    296   1.2      onoe 		mp = &m->m_nextpkt;
    297   1.2      onoe 	}
    298   1.2      onoe 	ifh->ifh_ft_size &= ~htons(IEEE1394_FT_MORE);	/* last fragment */
    299   1.2      onoe 	m_adj(m0, -(m0->m_pkthdr.len - maxsize));
    300   1.2      onoe 
    301   1.2      onoe 	ic->ic_dgl++;
    302   1.2      onoe 	return m0;
    303   1.2      onoe 
    304   1.2      onoe   bad:
    305   1.2      onoe 	while ((m = m0) != NULL) {
    306   1.2      onoe 		m0 = m->m_nextpkt;
    307   1.2      onoe 		m->m_nextpkt = NULL;
    308   1.2      onoe 		m_freem(m);
    309   1.2      onoe 	}
    310   1.2      onoe 	return NULL;
    311   1.2      onoe }
    312   1.2      onoe 
    313  1.29  kiyohara void
    314  1.39      matt ieee1394_input(struct ifnet *ifp, struct mbuf *m, uint16_t src)
    315   1.1      onoe {
    316  1.47     rmind 	pktqueue_t *pktq = NULL;
    317   1.1      onoe 	struct ifqueue *inq;
    318  1.39      matt 	uint16_t etype;
    319   1.1      onoe 	int s;
    320   1.1      onoe 	struct ieee1394_unfraghdr *iuh;
    321  1.46   msaitoh 	int isr = 0;
    322   1.1      onoe 
    323   1.1      onoe 	if ((ifp->if_flags & IFF_UP) == 0) {
    324   1.1      onoe 		m_freem(m);
    325   1.1      onoe 		return;
    326   1.1      onoe 	}
    327  1.29  kiyohara 	if (m->m_len < sizeof(*iuh)) {
    328  1.29  kiyohara 		if ((m = m_pullup(m, sizeof(*iuh))) == NULL)
    329   1.2      onoe 			return;
    330   1.2      onoe 	}
    331   1.1      onoe 
    332  1.29  kiyohara 	iuh = mtod(m, struct ieee1394_unfraghdr *);
    333   1.2      onoe 
    334   1.2      onoe 	if (ntohs(iuh->iuh_ft) & (IEEE1394_FT_SUBSEQ | IEEE1394_FT_MORE)) {
    335  1.29  kiyohara 		if ((m = ieee1394_reass(ifp, m, src)) == NULL)
    336   1.2      onoe 			return;
    337  1.29  kiyohara 		iuh = mtod(m, struct ieee1394_unfraghdr *);
    338   1.1      onoe 	}
    339   1.1      onoe 	etype = ntohs(iuh->iuh_etype);
    340   1.1      onoe 
    341   1.1      onoe 	/* strip off the ieee1394 header */
    342  1.29  kiyohara 	m_adj(m, sizeof(*iuh));
    343  1.30  kiyohara 	if (ifp->if_bpf) {
    344  1.30  kiyohara 		struct ieee1394_bpfhdr h;
    345  1.30  kiyohara 		struct m_tag *mtag;
    346  1.36    dyoung 		const struct ieee1394_hwaddr *myaddr;
    347  1.30  kiyohara 
    348  1.43  kiyohara 		mtag = m_tag_find(m, MTAG_FIREWIRE_SENDER_EUID, 0);
    349  1.30  kiyohara 		if (mtag)
    350  1.30  kiyohara 			memcpy(h.ibh_shost, mtag + 1, 8);
    351  1.30  kiyohara 		else
    352  1.30  kiyohara 			memset(h.ibh_shost, 0, 8);
    353  1.30  kiyohara 		if (m->m_flags & M_BCAST)
    354  1.30  kiyohara 			memcpy(h.ibh_dhost,
    355  1.30  kiyohara 			    ((const struct ieee1394_hwaddr *)
    356  1.30  kiyohara 			    ifp->if_broadcastaddr)->iha_uid, 8);
    357  1.30  kiyohara 		else {
    358  1.36    dyoung 			myaddr =
    359  1.36    dyoung 			  (const struct ieee1394_hwaddr *)CLLADDR(ifp->if_sadl);
    360  1.30  kiyohara 			memcpy(h.ibh_dhost, myaddr->iha_uid, 8);
    361  1.30  kiyohara 		}
    362  1.30  kiyohara 		h.ibh_type = htons(etype);
    363  1.45     joerg 		bpf_mtap2(ifp->if_bpf, &h, sizeof(h), m);
    364  1.30  kiyohara 	}
    365   1.1      onoe 
    366   1.1      onoe 	switch (etype) {
    367   1.1      onoe #ifdef INET
    368   1.1      onoe 	case ETHERTYPE_IP:
    369  1.47     rmind 		pktq = ip_pktq;
    370   1.1      onoe 		break;
    371   1.1      onoe 
    372   1.1      onoe 	case ETHERTYPE_ARP:
    373  1.46   msaitoh 		isr = NETISR_ARP;
    374  1.16    itojun 		inq = &arpintrq;
    375  1.17     enami 		break;
    376   1.1      onoe #endif /* INET */
    377   1.1      onoe 
    378   1.1      onoe #ifdef INET6
    379   1.1      onoe 	case ETHERTYPE_IPV6:
    380  1.47     rmind 		pktq = ip6_pktq;
    381   1.1      onoe 		break;
    382   1.1      onoe #endif /* INET6 */
    383   1.1      onoe 
    384   1.1      onoe 	default:
    385   1.1      onoe 		m_freem(m);
    386   1.1      onoe 		return;
    387   1.1      onoe 	}
    388   1.1      onoe 
    389  1.47     rmind 	if (__predict_true(pktq)) {
    390  1.47     rmind 		if (__predict_false(!pktq_enqueue(pktq, m, 0))) {
    391  1.47     rmind 			m_freem(m);
    392  1.47     rmind 		}
    393  1.47     rmind 		return;
    394  1.47     rmind 	}
    395  1.47     rmind 
    396  1.10   thorpej 	s = splnet();
    397   1.1      onoe 	if (IF_QFULL(inq)) {
    398   1.1      onoe 		IF_DROP(inq);
    399   1.1      onoe 		m_freem(m);
    400  1.46   msaitoh 	} else {
    401   1.1      onoe 		IF_ENQUEUE(inq, m);
    402  1.46   msaitoh 		schednetisr(isr);
    403  1.46   msaitoh 	}
    404   1.1      onoe 	splx(s);
    405   1.1      onoe }
    406   1.1      onoe 
    407   1.2      onoe static struct mbuf *
    408  1.39      matt ieee1394_reass(struct ifnet *ifp, struct mbuf *m0, uint16_t src)
    409   1.2      onoe {
    410   1.2      onoe 	struct ieee1394com *ic = (struct ieee1394com *)ifp;
    411   1.2      onoe 	struct ieee1394_fraghdr *ifh;
    412   1.2      onoe 	struct ieee1394_unfraghdr *iuh;
    413   1.2      onoe 	struct ieee1394_reassq *rq;
    414  1.25  christos 	struct ieee1394_reass_pkt *rp, *trp, *nrp = NULL;
    415   1.2      onoe 	int len;
    416  1.39      matt 	uint16_t etype, off, ftype, size, dgl;
    417  1.39      matt 	uint32_t id;
    418   1.2      onoe 
    419  1.29  kiyohara 	if (m0->m_len < sizeof(*ifh)) {
    420  1.29  kiyohara 		if ((m0 = m_pullup(m0, sizeof(*ifh))) == NULL)
    421   1.2      onoe 			return NULL;
    422   1.2      onoe 	}
    423  1.29  kiyohara 	ifh = mtod(m0, struct ieee1394_fraghdr *);
    424  1.29  kiyohara 	m_adj(m0, sizeof(*ifh));
    425   1.2      onoe 	size = ntohs(ifh->ifh_ft_size);
    426   1.2      onoe 	ftype = size & (IEEE1394_FT_SUBSEQ | IEEE1394_FT_MORE);
    427   1.2      onoe 	size = (size & ~ftype) + 1;
    428  1.29  kiyohara 	dgl = ntohs(ifh->ifh_dgl);
    429   1.2      onoe 	len = m0->m_pkthdr.len;
    430  1.29  kiyohara 	id = dgl | (src << 16);
    431   1.2      onoe 	if (ftype & IEEE1394_FT_SUBSEQ) {
    432  1.24    itojun 		m_tag_delete_chain(m0, NULL);
    433   1.2      onoe 		m0->m_flags &= ~M_PKTHDR;
    434  1.29  kiyohara 		etype = 0;
    435   1.2      onoe 		off = ntohs(ifh->ifh_etype_off);
    436  1.29  kiyohara 	} else {
    437  1.29  kiyohara 		etype = ifh->ifh_etype_off;
    438   1.2      onoe 		off = 0;
    439  1.29  kiyohara 	}
    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.29  kiyohara 			rq->fr_id = id;
    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.29  kiyohara 		if (rq->fr_id == id)
    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.29  kiyohara 			rp->rp_etype = etype;	 /* over writing trust etype */
    514   1.2      onoe 			rp->rp_len += len;
    515   1.2      onoe 			m0 = NULL;	/* mark merged */
    516   1.2      onoe 			break;
    517   1.2      onoe 		}
    518   1.2      onoe 		if (rp->rp_off > off) {
    519   1.2      onoe 			/* insert before rp */
    520   1.2      onoe 			nrp = rp;
    521   1.2      onoe 			break;
    522   1.2      onoe 		}
    523   1.2      onoe 		if (nrp == NULL || nrp->rp_dgl != dgl) {
    524   1.2      onoe 			/* insert after rp */
    525   1.2      onoe 			nrp = NULL;
    526   1.2      onoe 			break;
    527   1.2      onoe 		}
    528   1.2      onoe 	}
    529   1.2      onoe 	if (m0 == NULL) {
    530   1.2      onoe 		if (rp->rp_off != 0 || rp->rp_len != size)
    531   1.2      onoe 			return NULL;
    532   1.2      onoe 		/* fragment done */
    533   1.2      onoe 		LIST_REMOVE(rp, rp_next);
    534   1.2      onoe 		m0 = rp->rp_m;
    535   1.2      onoe 		m0->m_pkthdr.len = rp->rp_len;
    536  1.29  kiyohara 		M_PREPEND(m0, sizeof(*iuh), M_DONTWAIT);
    537   1.2      onoe 		if (m0 != NULL) {
    538  1.29  kiyohara 			iuh = mtod(m0, struct ieee1394_unfraghdr *);
    539   1.2      onoe 			iuh->iuh_ft = 0;
    540   1.2      onoe 			iuh->iuh_etype = rp->rp_etype;
    541   1.2      onoe 		}
    542   1.2      onoe 		free(rp, M_FTABLE);
    543   1.2      onoe 		return m0;
    544   1.2      onoe 	}
    545   1.2      onoe 
    546   1.2      onoe 	/*
    547   1.2      onoe 	 * New fragment received.  Allocate reassemble queue structure.
    548   1.2      onoe 	 */
    549   1.2      onoe 	trp = malloc(sizeof(*trp), M_FTABLE, M_NOWAIT);
    550   1.2      onoe 	if (trp == NULL) {
    551   1.2      onoe 		m_freem(m0);
    552   1.2      onoe 		return NULL;
    553   1.2      onoe 	}
    554   1.2      onoe 	trp->rp_m = m0;
    555   1.2      onoe 	trp->rp_size = size;
    556  1.29  kiyohara 	trp->rp_etype = etype;		 /* valid only if off==0 */
    557   1.2      onoe 	trp->rp_off = off;
    558   1.2      onoe 	trp->rp_dgl = dgl;
    559   1.2      onoe 	trp->rp_len = len;
    560   1.3      onoe 	trp->rp_ttl = IEEE1394_REASS_TIMEOUT;
    561   1.3      onoe 	if (trp->rp_ttl <= ifp->if_timer)
    562   1.3      onoe 		trp->rp_ttl = ifp->if_timer + 1;
    563   1.2      onoe 
    564   1.2      onoe 	if (rp == NULL) {
    565   1.2      onoe 		/* first fragment for the dgl */
    566   1.2      onoe 		LIST_INSERT_HEAD(&rq->rq_pkt, trp, rp_next);
    567   1.2      onoe 	} else if (nrp == NULL) {
    568   1.2      onoe 		/* no next fragment for the dgl */
    569   1.2      onoe 		LIST_INSERT_AFTER(rp, trp, rp_next);
    570   1.2      onoe 	} else {
    571   1.2      onoe 		/* there is a hole */
    572   1.2      onoe 		LIST_INSERT_BEFORE(nrp, trp, rp_next);
    573   1.2      onoe 	}
    574   1.2      onoe 	return NULL;
    575   1.2      onoe }
    576   1.2      onoe 
    577   1.3      onoe void
    578   1.3      onoe ieee1394_drain(struct ifnet *ifp)
    579   1.3      onoe {
    580   1.3      onoe 	struct ieee1394com *ic = (struct ieee1394com *)ifp;
    581   1.3      onoe 	struct ieee1394_reassq *rq;
    582   1.3      onoe 	struct ieee1394_reass_pkt *rp;
    583   1.3      onoe 
    584   1.3      onoe 	while ((rq = LIST_FIRST(&ic->ic_reassq)) != NULL) {
    585   1.3      onoe 		LIST_REMOVE(rq, rq_node);
    586   1.3      onoe 		while ((rp = LIST_FIRST(&rq->rq_pkt)) != NULL) {
    587   1.3      onoe 			LIST_REMOVE(rp, rp_next);
    588   1.3      onoe 			m_freem(rp->rp_m);
    589   1.3      onoe 			free(rp, M_FTABLE);
    590   1.3      onoe 		}
    591   1.3      onoe 		free(rq, M_FTABLE);
    592   1.3      onoe 	}
    593   1.3      onoe }
    594   1.3      onoe 
    595   1.3      onoe void
    596   1.3      onoe ieee1394_watchdog(struct ifnet *ifp)
    597   1.3      onoe {
    598   1.3      onoe 	struct ieee1394com *ic = (struct ieee1394com *)ifp;
    599   1.3      onoe 	struct ieee1394_reassq *rq;
    600   1.3      onoe 	struct ieee1394_reass_pkt *rp, *nrp;
    601   1.3      onoe 	int dec;
    602   1.3      onoe 
    603   1.3      onoe 	dec = (ifp->if_timer > 0) ? ifp->if_timer : 1;
    604   1.3      onoe 	for (rq = LIST_FIRST(&ic->ic_reassq); rq != NULL;
    605   1.3      onoe 	    rq = LIST_NEXT(rq, rq_node)) {
    606   1.3      onoe 		for (rp = LIST_FIRST(&rq->rq_pkt); rp != NULL; rp = nrp) {
    607   1.3      onoe 			nrp = LIST_NEXT(rp, rp_next);
    608   1.3      onoe 			if (rp->rp_ttl >= dec)
    609   1.3      onoe 				rp->rp_ttl -= dec;
    610   1.3      onoe 			else {
    611   1.3      onoe 				LIST_REMOVE(rp, rp_next);
    612   1.3      onoe 				m_freem(rp->rp_m);
    613   1.3      onoe 				free(rp, M_FTABLE);
    614   1.3      onoe 			}
    615   1.3      onoe 		}
    616   1.3      onoe 	}
    617   1.3      onoe }
    618   1.3      onoe 
    619   1.1      onoe const char *
    620  1.39      matt ieee1394_sprintf(const uint8_t *laddr)
    621   1.1      onoe {
    622   1.1      onoe 	static char buf[3*8];
    623   1.1      onoe 
    624   1.1      onoe 	snprintf(buf, sizeof(buf), "%02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x",
    625   1.1      onoe 	    laddr[0], laddr[1], laddr[2], laddr[3],
    626   1.1      onoe 	    laddr[4], laddr[5], laddr[6], laddr[7]);
    627   1.1      onoe 	return buf;
    628   1.1      onoe }
    629   1.1      onoe 
    630   1.1      onoe void
    631   1.1      onoe ieee1394_ifattach(struct ifnet *ifp, const struct ieee1394_hwaddr *hwaddr)
    632   1.1      onoe {
    633   1.2      onoe 	struct ieee1394_hwaddr *baddr;
    634   1.2      onoe 	struct ieee1394com *ic = (struct ieee1394com *)ifp;
    635   1.1      onoe 
    636   1.1      onoe 	ifp->if_type = IFT_IEEE1394;
    637   1.1      onoe 	ifp->if_hdrlen = sizeof(struct ieee1394_header);
    638   1.6   thorpej 	ifp->if_dlt = DLT_EN10MB;	/* XXX */
    639   1.1      onoe 	ifp->if_mtu = IEEE1394MTU;
    640   1.1      onoe 	ifp->if_output = ieee1394_output;
    641   1.3      onoe 	ifp->if_drain = ieee1394_drain;
    642   1.3      onoe 	ifp->if_watchdog = ieee1394_watchdog;
    643   1.3      onoe 	ifp->if_timer = 1;
    644   1.1      onoe 	if (ifp->if_baudrate == 0)
    645   1.1      onoe 		ifp->if_baudrate = IF_Mbps(100);
    646   1.7   thorpej 
    647  1.41    dyoung 	if_set_sadl(ifp, hwaddr, sizeof(struct ieee1394_hwaddr), true);
    648   1.7   thorpej 
    649  1.28      yamt 	baddr = malloc(ifp->if_addrlen, M_DEVBUF, M_WAITOK);
    650   1.2      onoe 	memset(baddr->iha_uid, 0xff, IEEE1394_ADDR_LEN);
    651   1.3      onoe 	baddr->iha_speed = 0;	/*XXX: how to determine the speed for bcast? */
    652   1.2      onoe 	baddr->iha_maxrec = 512 << baddr->iha_speed;
    653   1.2      onoe 	memset(baddr->iha_offset, 0, sizeof(baddr->iha_offset));
    654  1.28      yamt 	ifp->if_broadcastaddr = (uint8_t *)baddr;
    655   1.2      onoe 	LIST_INIT(&ic->ic_reassq);
    656  1.45     joerg 	bpf_attach(ifp, DLT_APPLE_IP_OVER_IEEE1394,
    657  1.45     joerg 	    sizeof(struct ieee1394_hwaddr));
    658   1.1      onoe }
    659   1.1      onoe 
    660   1.1      onoe void
    661   1.1      onoe ieee1394_ifdetach(struct ifnet *ifp)
    662   1.1      onoe {
    663   1.3      onoe 	ieee1394_drain(ifp);
    664  1.45     joerg 	bpf_detach(ifp);
    665  1.28      yamt 	free(__UNCONST(ifp->if_broadcastaddr), M_DEVBUF);
    666   1.7   thorpej 	ifp->if_broadcastaddr = NULL;
    667   1.1      onoe }
    668   1.1      onoe 
    669   1.1      onoe int
    670  1.34  christos ieee1394_ioctl(struct ifnet *ifp, u_long cmd, void *data)
    671   1.1      onoe {
    672   1.1      onoe 	struct ifreq *ifr = (struct ifreq *)data;
    673   1.1      onoe 	struct ifaddr *ifa = (struct ifaddr *)data;
    674   1.1      onoe 	int error = 0;
    675   1.1      onoe 
    676   1.1      onoe 	switch (cmd) {
    677  1.41    dyoung 	case SIOCINITIFADDR:
    678   1.1      onoe 		ifp->if_flags |= IFF_UP;
    679   1.1      onoe 		switch (ifa->ifa_addr->sa_family) {
    680   1.1      onoe #ifdef INET
    681   1.1      onoe 		case AF_INET:
    682   1.1      onoe 			if ((error = (*ifp->if_init)(ifp)) != 0)
    683   1.1      onoe 				break;
    684  1.16    itojun 			arp_ifinit(ifp, ifa);
    685   1.1      onoe 			break;
    686   1.1      onoe #endif /* INET */
    687   1.1      onoe 		default:
    688   1.1      onoe 			error = (*ifp->if_init)(ifp);
    689   1.1      onoe 			break;
    690   1.1      onoe 		}
    691   1.1      onoe 		break;
    692   1.1      onoe 
    693   1.1      onoe 	case SIOCSIFMTU:
    694   1.1      onoe 		if (ifr->ifr_mtu > IEEE1394MTU)
    695   1.1      onoe 			error = EINVAL;
    696  1.38    dyoung 		else if ((error = ifioctl_common(ifp, cmd, data)) == ENETRESET)
    697  1.38    dyoung 			error = 0;
    698   1.1      onoe 		break;
    699   1.1      onoe 
    700   1.1      onoe 	default:
    701  1.41    dyoung 		error = ifioctl_common(ifp, cmd, data);
    702   1.1      onoe 		break;
    703   1.1      onoe 	}
    704   1.1      onoe 
    705   1.1      onoe 	return error;
    706   1.1      onoe }
    707