1 /*- 2 * Copyright (c) 2002-2003 3 * Hidetoshi Shimokawa. All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 3. All advertising materials mentioning features or use of this software 14 * must display the following acknowledgement: 15 * 16 * This product includes software developed by Hidetoshi Shimokawa. 17 * 18 * 4. Neither the name of the author nor the names of its contributors 19 * may be used to endorse or promote products derived from this software 20 * without specific prior written permission. 21 * 22 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND 23 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 24 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 25 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE 26 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 27 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 28 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 29 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 30 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 31 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 32 * SUCH DAMAGE. 33 * 34 * $FreeBSD$ 35 */ 36 37 #ifdef HAVE_KERNEL_OPTION_HEADERS 38 #include "opt_device_polling.h" 39 #include "opt_inet.h" 40 #endif 41 42 #include <sys/param.h> 43 #include <sys/kernel.h> 44 #include <sys/malloc.h> 45 #include <sys/mbuf.h> 46 #include <sys/socket.h> 47 #include <sys/sockio.h> 48 #include <sys/sysctl.h> 49 #include <sys/systm.h> 50 #include <sys/module.h> 51 #include <sys/bus.h> 52 #include <machine/bus.h> 53 54 #include <net/bpf.h> 55 #include <net/ethernet.h> 56 #include <net/if.h> 57 #include <net/if_var.h> 58 #include <net/if_arp.h> 59 #include <net/if_types.h> 60 #ifdef __DragonFly__ 61 #include <net/vlan/if_vlan_var.h> 62 #include <bus/firewire/firewire.h> 63 #include <bus/firewire/firewirereg.h> 64 #include "if_fwevar.h" 65 #else 66 #include <net/if_vlan_var.h> 67 68 #include <dev/firewire/firewire.h> 69 #include <dev/firewire/firewirereg.h> 70 #include <dev/firewire/if_fwevar.h> 71 #endif 72 73 #define FWEDEBUG if (fwedebug) if_printf 74 #define TX_MAX_QUEUE (FWMAXQUEUE - 1) 75 76 /* network interface */ 77 static void fwe_start (struct ifnet *); 78 static int fwe_ioctl (struct ifnet *, u_long, caddr_t); 79 static void fwe_init (void *); 80 81 static void fwe_output_callback (struct fw_xfer *); 82 static void fwe_as_output (struct fwe_softc *, struct ifnet *); 83 static void fwe_as_input (struct fw_xferq *); 84 85 static int fwedebug = 0; 86 static int stream_ch = 1; 87 static int tx_speed = 2; 88 static int rx_queue_len = FWMAXQUEUE; 89 90 static MALLOC_DEFINE(M_FWE, "if_fwe", "Ethernet over FireWire interface"); 91 SYSCTL_INT(_debug, OID_AUTO, if_fwe_debug, CTLFLAG_RW, &fwedebug, 0, ""); 92 SYSCTL_DECL(_hw_firewire); 93 static SYSCTL_NODE(_hw_firewire, OID_AUTO, fwe, CTLFLAG_RD, 0, 94 "Ethernet emulation subsystem"); 95 SYSCTL_INT(_hw_firewire_fwe, OID_AUTO, stream_ch, CTLFLAG_RW, &stream_ch, 0, 96 "Stream channel to use"); 97 SYSCTL_INT(_hw_firewire_fwe, OID_AUTO, tx_speed, CTLFLAG_RW, &tx_speed, 0, 98 "Transmission speed"); 99 SYSCTL_INT(_hw_firewire_fwe, OID_AUTO, rx_queue_len, CTLFLAG_RW, &rx_queue_len, 100 0, "Length of the receive queue"); 101 102 TUNABLE_INT("hw.firewire.fwe.stream_ch", &stream_ch); 103 TUNABLE_INT("hw.firewire.fwe.tx_speed", &tx_speed); 104 TUNABLE_INT("hw.firewire.fwe.rx_queue_len", &rx_queue_len); 105 106 #ifdef DEVICE_POLLING 107 static poll_handler_t fwe_poll; 108 109 static int 110 fwe_poll(struct ifnet *ifp, enum poll_cmd cmd, int count) 111 { 112 struct fwe_softc *fwe; 113 struct firewire_comm *fc; 114 115 if (!(ifp->if_drv_flags & IFF_DRV_RUNNING)) 116 return (0); 117 118 fwe = ((struct fwe_eth_softc *)ifp->if_softc)->fwe; 119 fc = fwe->fd.fc; 120 fc->poll(fc, (cmd == POLL_AND_CHECK_STATUS)?0:1, count); 121 return (0); 122 } 123 #endif /* DEVICE_POLLING */ 124 125 static void 126 fwe_identify(driver_t *driver, device_t parent) 127 { 128 BUS_ADD_CHILD(parent, 0, "fwe", device_get_unit(parent)); 129 } 130 131 static int 132 fwe_probe(device_t dev) 133 { 134 device_t pa; 135 136 pa = device_get_parent(dev); 137 if(device_get_unit(dev) != device_get_unit(pa)){ 138 return(ENXIO); 139 } 140 141 device_set_desc(dev, "Ethernet over FireWire"); 142 return (0); 143 } 144 145 static int 146 fwe_attach(device_t dev) 147 { 148 struct fwe_softc *fwe; 149 struct ifnet *ifp; 150 int unit, s; 151 #if defined(__DragonFly__) || __FreeBSD_version < 500000 152 u_char *eaddr; 153 #else 154 u_char eaddr[6]; 155 #endif 156 struct fw_eui64 *eui; 157 158 fwe = ((struct fwe_softc *)device_get_softc(dev)); 159 unit = device_get_unit(dev); 160 161 bzero(fwe, sizeof(struct fwe_softc)); 162 mtx_init(&fwe->mtx, "fwe", NULL, MTX_DEF); 163 /* XXX */ 164 fwe->stream_ch = stream_ch; 165 fwe->dma_ch = -1; 166 167 fwe->fd.fc = device_get_ivars(dev); 168 if (tx_speed < 0) 169 tx_speed = fwe->fd.fc->speed; 170 171 fwe->fd.dev = dev; 172 fwe->fd.post_explore = NULL; 173 fwe->eth_softc.fwe = fwe; 174 175 fwe->pkt_hdr.mode.stream.tcode = FWTCODE_STREAM; 176 fwe->pkt_hdr.mode.stream.sy = 0; 177 fwe->pkt_hdr.mode.stream.chtag = fwe->stream_ch; 178 179 /* generate fake MAC address: first and last 3bytes from eui64 */ 180 #define LOCAL (0x02) 181 #define GROUP (0x01) 182 #if defined(__DragonFly__) || __FreeBSD_version < 500000 183 eaddr = &IFP2ENADDR(fwe->eth_softc.ifp)[0]; 184 #endif 185 186 187 eui = &fwe->fd.fc->eui; 188 eaddr[0] = (FW_EUI64_BYTE(eui, 0) | LOCAL) & ~GROUP; 189 eaddr[1] = FW_EUI64_BYTE(eui, 1); 190 eaddr[2] = FW_EUI64_BYTE(eui, 2); 191 eaddr[3] = FW_EUI64_BYTE(eui, 5); 192 eaddr[4] = FW_EUI64_BYTE(eui, 6); 193 eaddr[5] = FW_EUI64_BYTE(eui, 7); 194 printf("if_fwe%d: Fake Ethernet address: " 195 "%02x:%02x:%02x:%02x:%02x:%02x\n", unit, 196 eaddr[0], eaddr[1], eaddr[2], eaddr[3], eaddr[4], eaddr[5]); 197 198 /* fill the rest and attach interface */ 199 ifp = fwe->eth_softc.ifp = if_alloc(IFT_ETHER); 200 if (ifp == NULL) { 201 device_printf(dev, "can not if_alloc()\n"); 202 return (ENOSPC); 203 } 204 ifp->if_softc = &fwe->eth_softc; 205 206 #if __FreeBSD_version >= 501113 || defined(__DragonFly__) 207 if_initname(ifp, device_get_name(dev), unit); 208 #else 209 ifp->if_unit = unit; 210 ifp->if_name = "fwe"; 211 #endif 212 ifp->if_init = fwe_init; 213 #if defined(__DragonFly__) || __FreeBSD_version < 500000 214 ifp->if_output = ether_output; 215 #endif 216 ifp->if_start = fwe_start; 217 ifp->if_ioctl = fwe_ioctl; 218 ifp->if_flags = (IFF_BROADCAST|IFF_SIMPLEX|IFF_MULTICAST); 219 ifp->if_snd.ifq_maxlen = TX_MAX_QUEUE; 220 221 s = splimp(); 222 #if defined(__DragonFly__) || __FreeBSD_version < 500000 223 ether_ifattach(ifp, 1); 224 #else 225 ether_ifattach(ifp, eaddr); 226 #endif 227 splx(s); 228 229 /* Tell the upper layer(s) we support long frames. */ 230 ifp->if_data.ifi_hdrlen = sizeof(struct ether_vlan_header); 231 #if defined(__FreeBSD__) && __FreeBSD_version >= 500000 232 ifp->if_capabilities |= IFCAP_VLAN_MTU | IFCAP_POLLING; 233 ifp->if_capenable |= IFCAP_VLAN_MTU; 234 #endif 235 236 237 FWEDEBUG(ifp, "interface created\n"); 238 return 0; 239 } 240 241 static void 242 fwe_stop(struct fwe_softc *fwe) 243 { 244 struct firewire_comm *fc; 245 struct fw_xferq *xferq; 246 struct ifnet *ifp = fwe->eth_softc.ifp; 247 struct fw_xfer *xfer, *next; 248 int i; 249 250 fc = fwe->fd.fc; 251 252 if (fwe->dma_ch >= 0) { 253 xferq = fc->ir[fwe->dma_ch]; 254 255 if (xferq->flag & FWXFERQ_RUNNING) 256 fc->irx_disable(fc, fwe->dma_ch); 257 xferq->flag &= 258 ~(FWXFERQ_MODEMASK | FWXFERQ_OPEN | FWXFERQ_STREAM | 259 FWXFERQ_EXTBUF | FWXFERQ_HANDLER | FWXFERQ_CHTAGMASK); 260 xferq->hand = NULL; 261 262 for (i = 0; i < xferq->bnchunk; i ++) 263 m_freem(xferq->bulkxfer[i].mbuf); 264 free(xferq->bulkxfer, M_FWE); 265 266 for (xfer = STAILQ_FIRST(&fwe->xferlist); xfer != NULL; 267 xfer = next) { 268 next = STAILQ_NEXT(xfer, link); 269 fw_xfer_free(xfer); 270 } 271 STAILQ_INIT(&fwe->xferlist); 272 273 xferq->bulkxfer = NULL; 274 fwe->dma_ch = -1; 275 } 276 277 #if defined(__FreeBSD__) 278 ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE); 279 #else 280 ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE); 281 #endif 282 } 283 284 static int 285 fwe_detach(device_t dev) 286 { 287 struct fwe_softc *fwe; 288 struct ifnet *ifp; 289 int s; 290 291 fwe = device_get_softc(dev); 292 ifp = fwe->eth_softc.ifp; 293 294 #ifdef DEVICE_POLLING 295 if (ifp->if_capenable & IFCAP_POLLING) 296 ether_poll_deregister(ifp); 297 #endif 298 s = splimp(); 299 300 fwe_stop(fwe); 301 #if defined(__DragonFly__) || __FreeBSD_version < 500000 302 ether_ifdetach(ifp, 1); 303 #else 304 ether_ifdetach(ifp); 305 if_free(ifp); 306 #endif 307 308 splx(s); 309 mtx_destroy(&fwe->mtx); 310 return 0; 311 } 312 313 static void 314 fwe_init(void *arg) 315 { 316 struct fwe_softc *fwe = ((struct fwe_eth_softc *)arg)->fwe; 317 struct firewire_comm *fc; 318 struct ifnet *ifp = fwe->eth_softc.ifp; 319 struct fw_xferq *xferq; 320 struct fw_xfer *xfer; 321 struct mbuf *m; 322 int i; 323 324 FWEDEBUG(ifp, "initializing\n"); 325 326 /* XXX keep promiscoud mode */ 327 ifp->if_flags |= IFF_PROMISC; 328 329 fc = fwe->fd.fc; 330 if (fwe->dma_ch < 0) { 331 fwe->dma_ch = fw_open_isodma(fc, /* tx */0); 332 if (fwe->dma_ch < 0) 333 return; 334 xferq = fc->ir[fwe->dma_ch]; 335 xferq->flag |= FWXFERQ_EXTBUF | 336 FWXFERQ_HANDLER | FWXFERQ_STREAM; 337 fwe->stream_ch = stream_ch; 338 fwe->pkt_hdr.mode.stream.chtag = fwe->stream_ch; 339 xferq->flag &= ~0xff; 340 xferq->flag |= fwe->stream_ch & 0xff; 341 /* register fwe_input handler */ 342 xferq->sc = (caddr_t) fwe; 343 xferq->hand = fwe_as_input; 344 xferq->bnchunk = rx_queue_len; 345 xferq->bnpacket = 1; 346 xferq->psize = MCLBYTES; 347 xferq->queued = 0; 348 xferq->buf = NULL; 349 xferq->bulkxfer = (struct fw_bulkxfer *) malloc( 350 sizeof(struct fw_bulkxfer) * xferq->bnchunk, 351 M_FWE, M_WAITOK); 352 if (xferq->bulkxfer == NULL) { 353 printf("if_fwe: malloc failed\n"); 354 return; 355 } 356 STAILQ_INIT(&xferq->stvalid); 357 STAILQ_INIT(&xferq->stfree); 358 STAILQ_INIT(&xferq->stdma); 359 xferq->stproc = NULL; 360 for (i = 0; i < xferq->bnchunk; i ++) { 361 m = m_getcl(M_WAITOK, MT_DATA, M_PKTHDR); 362 xferq->bulkxfer[i].mbuf = m; 363 m->m_len = m->m_pkthdr.len = m->m_ext.ext_size; 364 STAILQ_INSERT_TAIL(&xferq->stfree, 365 &xferq->bulkxfer[i], link); 366 } 367 STAILQ_INIT(&fwe->xferlist); 368 for (i = 0; i < TX_MAX_QUEUE; i++) { 369 xfer = fw_xfer_alloc(M_FWE); 370 if (xfer == NULL) 371 break; 372 xfer->send.spd = tx_speed; 373 xfer->fc = fwe->fd.fc; 374 xfer->sc = (caddr_t)fwe; 375 xfer->hand = fwe_output_callback; 376 STAILQ_INSERT_TAIL(&fwe->xferlist, xfer, link); 377 } 378 } else 379 xferq = fc->ir[fwe->dma_ch]; 380 381 382 /* start dma */ 383 if ((xferq->flag & FWXFERQ_RUNNING) == 0) 384 fc->irx_enable(fc, fwe->dma_ch); 385 386 #if defined(__FreeBSD__) 387 ifp->if_drv_flags |= IFF_DRV_RUNNING; 388 ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 389 #else 390 ifp->if_flags |= IFF_RUNNING; 391 ifp->if_flags &= ~IFF_OACTIVE; 392 #endif 393 394 #if 0 395 /* attempt to start output */ 396 fwe_start(ifp); 397 #endif 398 } 399 400 401 static int 402 fwe_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data) 403 { 404 struct fwe_softc *fwe = ((struct fwe_eth_softc *)ifp->if_softc)->fwe; 405 struct ifstat *ifs = NULL; 406 int s, error; 407 408 switch (cmd) { 409 case SIOCSIFFLAGS: 410 s = splimp(); 411 if (ifp->if_flags & IFF_UP) { 412 #if defined(__FreeBSD__) 413 if (!(ifp->if_drv_flags & IFF_DRV_RUNNING)) 414 #else 415 if (!(ifp->if_flags & IFF_RUNNING)) 416 #endif 417 fwe_init(&fwe->eth_softc); 418 } else { 419 #if defined(__FreeBSD__) 420 if (ifp->if_drv_flags & IFF_DRV_RUNNING) 421 #else 422 if (ifp->if_flags & IFF_RUNNING) 423 #endif 424 fwe_stop(fwe); 425 } 426 /* XXX keep promiscoud mode */ 427 ifp->if_flags |= IFF_PROMISC; 428 splx(s); 429 break; 430 case SIOCADDMULTI: 431 case SIOCDELMULTI: 432 break; 433 434 case SIOCGIFSTATUS: 435 s = splimp(); 436 ifs = (struct ifstat *)data; 437 snprintf(ifs->ascii, sizeof(ifs->ascii), 438 "\tch %d dma %d\n", fwe->stream_ch, fwe->dma_ch); 439 splx(s); 440 break; 441 case SIOCSIFCAP: 442 #ifdef DEVICE_POLLING 443 { 444 struct ifreq *ifr = (struct ifreq *) data; 445 struct firewire_comm *fc = fwe->fd.fc; 446 447 if (ifr->ifr_reqcap & IFCAP_POLLING && 448 !(ifp->if_capenable & IFCAP_POLLING)) { 449 error = ether_poll_register(fwe_poll, ifp); 450 if (error) 451 return(error); 452 /* Disable interrupts */ 453 fc->set_intr(fc, 0); 454 ifp->if_capenable |= IFCAP_POLLING; 455 ifp->if_capenable |= IFCAP_POLLING_NOCOUNT; 456 return (error); 457 } 458 if (!(ifr->ifr_reqcap & IFCAP_POLLING) && 459 ifp->if_capenable & IFCAP_POLLING) { 460 error = ether_poll_deregister(ifp); 461 /* Enable interrupts. */ 462 fc->set_intr(fc, 1); 463 ifp->if_capenable &= ~IFCAP_POLLING; 464 ifp->if_capenable &= ~IFCAP_POLLING_NOCOUNT; 465 return (error); 466 } 467 } 468 #endif /* DEVICE_POLLING */ 469 break; 470 #if defined(__FreeBSD__) && __FreeBSD_version >= 500000 471 default: 472 #else 473 case SIOCSIFADDR: 474 case SIOCGIFADDR: 475 case SIOCSIFMTU: 476 #endif 477 s = splimp(); 478 error = ether_ioctl(ifp, cmd, data); 479 splx(s); 480 return (error); 481 #if defined(__DragonFly__) || __FreeBSD_version < 500000 482 default: 483 return (EINVAL); 484 #endif 485 } 486 487 return (0); 488 } 489 490 static void 491 fwe_output_callback(struct fw_xfer *xfer) 492 { 493 struct fwe_softc *fwe; 494 struct ifnet *ifp; 495 int s; 496 497 fwe = (struct fwe_softc *)xfer->sc; 498 ifp = fwe->eth_softc.ifp; 499 /* XXX error check */ 500 FWEDEBUG(ifp, "resp = %d\n", xfer->resp); 501 if (xfer->resp != 0) 502 ifp->if_oerrors ++; 503 504 m_freem(xfer->mbuf); 505 fw_xfer_unload(xfer); 506 507 s = splimp(); 508 FWE_LOCK(fwe); 509 STAILQ_INSERT_TAIL(&fwe->xferlist, xfer, link); 510 FWE_UNLOCK(fwe); 511 splx(s); 512 513 /* for queue full */ 514 if (ifp->if_snd.ifq_head != NULL) 515 fwe_start(ifp); 516 } 517 518 static void 519 fwe_start(struct ifnet *ifp) 520 { 521 struct fwe_softc *fwe = ((struct fwe_eth_softc *)ifp->if_softc)->fwe; 522 int s; 523 524 FWEDEBUG(ifp, "starting\n"); 525 526 if (fwe->dma_ch < 0) { 527 struct mbuf *m = NULL; 528 529 FWEDEBUG(ifp, "not ready\n"); 530 531 s = splimp(); 532 do { 533 IF_DEQUEUE(&ifp->if_snd, m); 534 if (m != NULL) 535 m_freem(m); 536 ifp->if_oerrors ++; 537 } while (m != NULL); 538 splx(s); 539 540 return; 541 } 542 543 s = splimp(); 544 #if defined(__FreeBSD__) 545 ifp->if_drv_flags |= IFF_DRV_OACTIVE; 546 #else 547 ifp->if_flags |= IFF_OACTIVE; 548 #endif 549 550 if (ifp->if_snd.ifq_len != 0) 551 fwe_as_output(fwe, ifp); 552 553 #if defined(__FreeBSD__) 554 ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 555 #else 556 ifp->if_flags &= ~IFF_OACTIVE; 557 #endif 558 splx(s); 559 } 560 561 #define HDR_LEN 4 562 #ifndef ETHER_ALIGN 563 #define ETHER_ALIGN 2 564 #endif 565 /* Async. stream output */ 566 static void 567 fwe_as_output(struct fwe_softc *fwe, struct ifnet *ifp) 568 { 569 struct mbuf *m; 570 struct fw_xfer *xfer; 571 struct fw_xferq *xferq; 572 struct fw_pkt *fp; 573 int i = 0; 574 575 xfer = NULL; 576 xferq = fwe->fd.fc->atq; 577 while ((xferq->queued < xferq->maxq - 1) && 578 (ifp->if_snd.ifq_head != NULL)) { 579 FWE_LOCK(fwe); 580 xfer = STAILQ_FIRST(&fwe->xferlist); 581 if (xfer == NULL) { 582 #if 0 583 printf("if_fwe: lack of xfer\n"); 584 #endif 585 FWE_UNLOCK(fwe); 586 break; 587 } 588 STAILQ_REMOVE_HEAD(&fwe->xferlist, link); 589 FWE_UNLOCK(fwe); 590 591 IF_DEQUEUE(&ifp->if_snd, m); 592 if (m == NULL) { 593 FWE_LOCK(fwe); 594 STAILQ_INSERT_HEAD(&fwe->xferlist, xfer, link); 595 FWE_UNLOCK(fwe); 596 break; 597 } 598 #if defined(__DragonFly__) || __FreeBSD_version < 500000 599 if (ifp->if_bpf != NULL) 600 bpf_mtap(ifp, m); 601 #else 602 BPF_MTAP(ifp, m); 603 #endif 604 605 /* keep ip packet alignment for alpha */ 606 M_PREPEND(m, ETHER_ALIGN, M_NOWAIT); 607 fp = &xfer->send.hdr; 608 *(uint32_t *)&xfer->send.hdr = *(int32_t *)&fwe->pkt_hdr; 609 fp->mode.stream.len = m->m_pkthdr.len; 610 xfer->mbuf = m; 611 xfer->send.pay_len = m->m_pkthdr.len; 612 613 if (fw_asyreq(fwe->fd.fc, -1, xfer) != 0) { 614 /* error */ 615 ifp->if_oerrors ++; 616 /* XXX set error code */ 617 fwe_output_callback(xfer); 618 } else { 619 ifp->if_opackets ++; 620 i++; 621 } 622 } 623 #if 0 624 if (i > 1) 625 printf("%d queued\n", i); 626 #endif 627 if (i > 0) 628 xferq->start(fwe->fd.fc); 629 } 630 631 /* Async. stream output */ 632 static void 633 fwe_as_input(struct fw_xferq *xferq) 634 { 635 struct mbuf *m, *m0; 636 struct ifnet *ifp; 637 struct fwe_softc *fwe; 638 struct fw_bulkxfer *sxfer; 639 struct fw_pkt *fp; 640 u_char *c; 641 #if defined(__DragonFly__) || __FreeBSD_version < 500000 642 struct ether_header *eh; 643 #endif 644 645 fwe = (struct fwe_softc *)xferq->sc; 646 ifp = fwe->eth_softc.ifp; 647 648 /* We do not need a lock here because the bottom half is serialized */ 649 while ((sxfer = STAILQ_FIRST(&xferq->stvalid)) != NULL) { 650 STAILQ_REMOVE_HEAD(&xferq->stvalid, link); 651 fp = mtod(sxfer->mbuf, struct fw_pkt *); 652 if (fwe->fd.fc->irx_post != NULL) 653 fwe->fd.fc->irx_post(fwe->fd.fc, fp->mode.ld); 654 m = sxfer->mbuf; 655 656 /* insert new rbuf */ 657 sxfer->mbuf = m0 = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR); 658 if (m0 != NULL) { 659 m0->m_len = m0->m_pkthdr.len = m0->m_ext.ext_size; 660 STAILQ_INSERT_TAIL(&xferq->stfree, sxfer, link); 661 } else 662 printf("%s: m_getcl failed\n", __FUNCTION__); 663 664 if (sxfer->resp != 0 || fp->mode.stream.len < 665 ETHER_ALIGN + sizeof(struct ether_header)) { 666 m_freem(m); 667 ifp->if_ierrors ++; 668 continue; 669 } 670 671 m->m_data += HDR_LEN + ETHER_ALIGN; 672 c = mtod(m, u_char *); 673 #if defined(__DragonFly__) || __FreeBSD_version < 500000 674 eh = (struct ether_header *)c; 675 m->m_data += sizeof(struct ether_header); 676 m->m_len = m->m_pkthdr.len = fp->mode.stream.len - ETHER_ALIGN 677 - sizeof(struct ether_header); 678 #else 679 m->m_len = m->m_pkthdr.len = fp->mode.stream.len - ETHER_ALIGN; 680 #endif 681 m->m_pkthdr.rcvif = ifp; 682 #if 0 683 FWEDEBUG(ifp, "%02x %02x %02x %02x %02x %02x\n" 684 "%02x %02x %02x %02x %02x %02x\n" 685 "%02x %02x %02x %02x\n" 686 "%02x %02x %02x %02x\n" 687 "%02x %02x %02x %02x\n" 688 "%02x %02x %02x %02x\n", 689 c[0], c[1], c[2], c[3], c[4], c[5], 690 c[6], c[7], c[8], c[9], c[10], c[11], 691 c[12], c[13], c[14], c[15], 692 c[16], c[17], c[18], c[19], 693 c[20], c[21], c[22], c[23], 694 c[20], c[21], c[22], c[23] 695 ); 696 #endif 697 #if defined(__DragonFly__) || __FreeBSD_version < 500000 698 ether_input(ifp, eh, m); 699 #else 700 (*ifp->if_input)(ifp, m); 701 #endif 702 ifp->if_ipackets ++; 703 } 704 if (STAILQ_FIRST(&xferq->stfree) != NULL) 705 fwe->fd.fc->irx_enable(fwe->fd.fc, fwe->dma_ch); 706 } 707 708 709 static devclass_t fwe_devclass; 710 711 static device_method_t fwe_methods[] = { 712 /* device interface */ 713 DEVMETHOD(device_identify, fwe_identify), 714 DEVMETHOD(device_probe, fwe_probe), 715 DEVMETHOD(device_attach, fwe_attach), 716 DEVMETHOD(device_detach, fwe_detach), 717 { 0, 0 } 718 }; 719 720 static driver_t fwe_driver = { 721 "fwe", 722 fwe_methods, 723 sizeof(struct fwe_softc), 724 }; 725 726 727 #ifdef __DragonFly__ 728 DECLARE_DUMMY_MODULE(fwe); 729 #endif 730 DRIVER_MODULE(fwe, firewire, fwe_driver, fwe_devclass, 0, 0); 731 MODULE_VERSION(fwe, 1); 732 MODULE_DEPEND(fwe, firewire, 1, 1, 1); 733