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