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