source: rtems-libbsd/freebsd/sys/net/if_fwsubr.c @ 09bbedc

#include <machine/rtems-bsd-kernel-space.h>

/*-
 * Copyright (c) 2004 Doug Rabson
 * Copyright (c) 1982, 1989, 1993
 *      The Regents of the University of California.  All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 * 3. Neither the name of the University nor the names of its contributors
 *    may be used to endorse or promote products derived from this software
 *    without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
 * SUCH DAMAGE.
 *
 * $FreeBSD$
 */

#include <rtems/bsd/local/opt_inet.h>
#include <rtems/bsd/local/opt_inet6.h>

#include <sys/param.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/malloc.h>
#include <sys/mbuf.h>
#include <sys/module.h>
#include <sys/socket.h>
#include <sys/sockio.h>

#include <net/if.h>
#include <net/if_var.h>
#include <net/netisr.h>
#include <net/route.h>
#include <net/if_llc.h>
#include <net/if_dl.h>
#include <net/if_types.h>
#include <net/bpf.h>
#include <net/firewire.h>
#include <net/if_llatbl.h>

#if defined(INET) || defined(INET6)
#include <netinet/in.h>
#include <netinet/in_var.h>
#include <netinet/if_ether.h>
#endif
#ifdef INET6
#include <netinet6/nd6.h>
#endif

#include <security/mac/mac_framework.h>

static MALLOC_DEFINE(M_FWCOM, "fw_com", "firewire interface internals");

struct fw_hwaddr firewire_broadcastaddr = {
        0xffffffff,
        0xffffffff,
        0xff,
        0xff,
        0xffff,
        0xffffffff
};

static int
firewire_output(struct ifnet *ifp, struct mbuf *m, const struct sockaddr *dst,
    struct route *ro)
{
        struct fw_com *fc = IFP2FWC(ifp);
        int error, type;
        struct m_tag *mtag;
        union fw_encap *enc;
        struct fw_hwaddr *destfw;
        uint8_t speed;
        uint16_t psize, fsize, dsize;
        struct mbuf *mtail;
        int unicast, dgl, foff;
        static int next_dgl;
#if defined(INET) || defined(INET6)
        int is_gw = 0;
#endif

#ifdef MAC
        error = mac_ifnet_check_transmit(ifp, m);
        if (error)
                goto bad;
#endif

        if (!((ifp->if_flags & IFF_UP) &&
           (ifp->if_drv_flags & IFF_DRV_RUNNING))) {
                error = ENETDOWN;
                goto bad;
        }

#if defined(INET) || defined(INET6)
        if (ro != NULL)
                is_gw = (ro->ro_flags & RT_HAS_GW) != 0;
#endif
        /*
         * For unicast, we make a tag to store the lladdr of the
         * destination. This might not be the first time we have seen
         * the packet (for instance, the arp code might be trying to
         * re-send it after receiving an arp reply) so we only
         * allocate a tag if there isn't one there already. For
         * multicast, we will eventually use a different tag to store
         * the channel number.
         */
        unicast = !(m->m_flags & (M_BCAST | M_MCAST));
        if (unicast) {
                mtag = m_tag_locate(m, MTAG_FIREWIRE, MTAG_FIREWIRE_HWADDR, NULL);
                if (!mtag) {
                        mtag = m_tag_alloc(MTAG_FIREWIRE, MTAG_FIREWIRE_HWADDR,
                            sizeof (struct fw_hwaddr), M_NOWAIT);
                        if (!mtag) {
                                error = ENOMEM;
                                goto bad;
                        }
                        m_tag_prepend(m, mtag);
                }
                destfw = (struct fw_hwaddr *)(mtag + 1);
        } else {
                destfw = NULL;
        }

        switch (dst->sa_family) {
#ifdef INET
        case AF_INET:
                /*
                 * Only bother with arp for unicast. Allocation of
                 * channels etc. for firewire is quite different and
                 * doesn't fit into the arp model.
                 */
                if (unicast) {
                        error = arpresolve(ifp, is_gw, m, dst,
                            (u_char *) destfw, NULL, NULL);
                        if (error)
                                return (error == EWOULDBLOCK ? 0 : error);
                }
                type = ETHERTYPE_IP;
                break;

        case AF_ARP:
        {
                struct arphdr *ah;
                ah = mtod(m, struct arphdr *);
                ah->ar_hrd = htons(ARPHRD_IEEE1394);
                type = ETHERTYPE_ARP;
                if (unicast)
                        *destfw = *(struct fw_hwaddr *) ar_tha(ah);

                /*
                 * The standard arp code leaves a hole for the target
                 * hardware address which we need to close up.
                 */
                bcopy(ar_tpa(ah), ar_tha(ah), ah->ar_pln);
                m_adj(m, -ah->ar_hln);
                break;
        }
#endif

#ifdef INET6
        case AF_INET6:
                if (unicast) {
                        error = nd6_resolve(fc->fc_ifp, is_gw, m, dst,
                            (u_char *) destfw, NULL, NULL);
                        if (error)
                                return (error == EWOULDBLOCK ? 0 : error);
                }
                type = ETHERTYPE_IPV6;
                break;
#endif

        default:
                if_printf(ifp, "can't handle af%d\n", dst->sa_family);
                error = EAFNOSUPPORT;
                goto bad;
        }

        /*
         * Let BPF tap off a copy before we encapsulate.
         */
        if (bpf_peers_present(ifp->if_bpf)) {
                struct fw_bpfhdr h;
                if (unicast)
                        bcopy(destfw, h.firewire_dhost, 8);
                else
                        bcopy(&firewire_broadcastaddr, h.firewire_dhost, 8);
                bcopy(&fc->fc_hwaddr, h.firewire_shost, 8);
                h.firewire_type = htons(type);
                bpf_mtap2(ifp->if_bpf, &h, sizeof(h), m);
        }

        /*
         * Punt on MCAP for now and send all multicast packets on the
         * broadcast channel.
         */
        if (m->m_flags & M_MCAST)
                m->m_flags |= M_BCAST;

        /*
         * Figure out what speed to use and what the largest supported
         * packet size is. For unicast, this is the minimum of what we
         * can speak and what they can hear. For broadcast, lets be
         * conservative and use S100. We could possibly improve that
         * by examining the bus manager's speed map or similar. We
         * also reduce the packet size for broadcast to account for
         * the GASP header.
         */
        if (unicast) {
                speed = min(fc->fc_speed, destfw->sspd);
                psize = min(512 << speed, 2 << destfw->sender_max_rec);
        } else {
                speed = 0;
                psize = 512 - 2*sizeof(uint32_t);
        }

        /*
         * Next, we encapsulate, possibly fragmenting the original
         * datagram if it won't fit into a single packet.
         */
        if (m->m_pkthdr.len <= psize - sizeof(uint32_t)) {
                /*
                 * No fragmentation is necessary.
                 */
                M_PREPEND(m, sizeof(uint32_t), M_NOWAIT);
                if (!m) {
                        error = ENOBUFS;
                        goto bad;
                }
                enc = mtod(m, union fw_encap *);
                enc->unfrag.ether_type = type;
                enc->unfrag.lf = FW_ENCAP_UNFRAG;
                enc->unfrag.reserved = 0;

                /*
                 * Byte swap the encapsulation header manually.
                 */
                enc->ul[0] = htonl(enc->ul[0]);

                error = (ifp->if_transmit)(ifp, m);
                return (error);
        } else {
                /*
                 * Fragment the datagram, making sure to leave enough
                 * space for the encapsulation header in each packet.
                 */
                fsize = psize - 2*sizeof(uint32_t);
                dgl = next_dgl++;
                dsize = m->m_pkthdr.len;
                foff = 0;
                while (m) {
                        if (m->m_pkthdr.len > fsize) {
                                /*
                                 * Split off the tail segment from the
                                 * datagram, copying our tags over.
                                 */
                                mtail = m_split(m, fsize, M_NOWAIT);
                                m_tag_copy_chain(mtail, m, M_NOWAIT);
                        } else {
                                mtail = NULL;
                        }

                        /*
                         * Add our encapsulation header to this
                         * fragment and hand it off to the link.
                         */
                        M_PREPEND(m, 2*sizeof(uint32_t), M_NOWAIT);
                        if (!m) {
                                error = ENOBUFS;
                                goto bad;
                        }
                        enc = mtod(m, union fw_encap *);
                        if (foff == 0) {
                                enc->firstfrag.lf = FW_ENCAP_FIRST;
                                enc->firstfrag.reserved1 = 0;
                                enc->firstfrag.reserved2 = 0;
                                enc->firstfrag.datagram_size = dsize - 1;
                                enc->firstfrag.ether_type = type;
                                enc->firstfrag.dgl = dgl;
                        } else {
                                if (mtail)
                                        enc->nextfrag.lf = FW_ENCAP_NEXT;
                                else
                                        enc->nextfrag.lf = FW_ENCAP_LAST;
                                enc->nextfrag.reserved1 = 0;
                                enc->nextfrag.reserved2 = 0;
                                enc->nextfrag.reserved3 = 0;
                                enc->nextfrag.datagram_size = dsize - 1;
                                enc->nextfrag.fragment_offset = foff;
                                enc->nextfrag.dgl = dgl;
                        }
                        foff += m->m_pkthdr.len - 2*sizeof(uint32_t);

                        /*
                         * Byte swap the encapsulation header manually.
                         */
                        enc->ul[0] = htonl(enc->ul[0]);
                        enc->ul[1] = htonl(enc->ul[1]);

                        error = (ifp->if_transmit)(ifp, m);
                        if (error) {
                                if (mtail)
                                        m_freem(mtail);
                                return (ENOBUFS);
                        }

                        m = mtail;
                }

                return (0);
        }

bad:
        if (m)
                m_freem(m);
        return (error);
}

static struct mbuf *
firewire_input_fragment(struct fw_com *fc, struct mbuf *m, int src)
{
        union fw_encap *enc;
        struct fw_reass *r;
        struct mbuf *mf, *mprev;
        int dsize;
        int fstart, fend, start, end, islast;
        uint32_t id;

        /*
         * Find an existing reassembly buffer or create a new one.
         */
        enc = mtod(m, union fw_encap *);
        id = enc->firstfrag.dgl | (src << 16);
        STAILQ_FOREACH(r, &fc->fc_frags, fr_link)
                if (r->fr_id == id)
                        break;
        if (!r) {
                r = malloc(sizeof(struct fw_reass), M_TEMP, M_NOWAIT);
                if (!r) {
                        m_freem(m);
                        return 0;
                }
                r->fr_id = id;
                r->fr_frags = 0;
                STAILQ_INSERT_HEAD(&fc->fc_frags, r, fr_link);
        }

        /*
         * If this fragment overlaps any other fragment, we must discard
         * the partial reassembly and start again.
         */
        if (enc->firstfrag.lf == FW_ENCAP_FIRST)
                fstart = 0;
        else
                fstart = enc->nextfrag.fragment_offset;
        fend = fstart + m->m_pkthdr.len - 2*sizeof(uint32_t);
        dsize = enc->nextfrag.datagram_size;
        islast = (enc->nextfrag.lf == FW_ENCAP_LAST);

        for (mf = r->fr_frags; mf; mf = mf->m_nextpkt) {
                enc = mtod(mf, union fw_encap *);
                if (enc->nextfrag.datagram_size != dsize) {
                        /*
                         * This fragment must be from a different
                         * packet.
                         */
                        goto bad;
                }
                if (enc->firstfrag.lf == FW_ENCAP_FIRST)
                        start = 0;
                else
                        start = enc->nextfrag.fragment_offset;
                end = start + mf->m_pkthdr.len - 2*sizeof(uint32_t);
                if ((fstart < end && fend > start) ||
                    (islast && enc->nextfrag.lf == FW_ENCAP_LAST)) {
                        /*
                         * Overlap - discard reassembly buffer and start
                         * again with this fragment.
                         */
                        goto bad;
                }
        }

        /*
         * Find where to put this fragment in the list.
         */
        for (mf = r->fr_frags, mprev = NULL; mf;
            mprev = mf, mf = mf->m_nextpkt) {
                enc = mtod(mf, union fw_encap *);
                if (enc->firstfrag.lf == FW_ENCAP_FIRST)
                        start = 0;
                else
                        start = enc->nextfrag.fragment_offset;
                if (start >= fend)
                        break;
        }

        /*
         * If this is a last fragment and we are not adding at the end
         * of the list, discard the buffer.
         */
        if (islast && mprev && mprev->m_nextpkt)
                goto bad;

        if (mprev) {
                m->m_nextpkt = mprev->m_nextpkt;
                mprev->m_nextpkt = m;

                /*
                 * Coalesce forwards and see if we can make a whole
                 * datagram.
                 */
                enc = mtod(mprev, union fw_encap *);
                if (enc->firstfrag.lf == FW_ENCAP_FIRST)
                        start = 0;
                else
                        start = enc->nextfrag.fragment_offset;
                end = start + mprev->m_pkthdr.len - 2*sizeof(uint32_t);
                while (end == fstart) {
                        /*
                         * Strip off the encap header from m and
                         * append it to mprev, freeing m.
                         */
                        m_adj(m, 2*sizeof(uint32_t));
                        mprev->m_nextpkt = m->m_nextpkt;
                        mprev->m_pkthdr.len += m->m_pkthdr.len;
                        m_cat(mprev, m);

                        if (mprev->m_pkthdr.len == dsize + 1 + 2*sizeof(uint32_t)) {
                                /*
                                 * We have assembled a complete packet
                                 * we must be finished. Make sure we have
                                 * merged the whole chain.
                                 */
                                STAILQ_REMOVE(&fc->fc_frags, r, fw_reass, fr_link);
                                free(r, M_TEMP);
                                m = mprev->m_nextpkt;
                                while (m) {
                                        mf = m->m_nextpkt;
                                        m_freem(m);
                                        m = mf;
                                }
                                mprev->m_nextpkt = NULL;

                                return (mprev);
                        }

                        /*
                         * See if we can continue merging forwards.
                         */
                        end = fend;
                        m = mprev->m_nextpkt;
                        if (m) {
                                enc = mtod(m, union fw_encap *);
                                if (enc->firstfrag.lf == FW_ENCAP_FIRST)
                                        fstart = 0;
                                else
                                        fstart = enc->nextfrag.fragment_offset;
                                fend = fstart + m->m_pkthdr.len
                                    - 2*sizeof(uint32_t);
                        } else {
                                break;
                        }
                }
        } else {
                m->m_nextpkt = 0;
                r->fr_frags = m;
        }

        return (0);

bad:
        while (r->fr_frags) {
                mf = r->fr_frags;
                r->fr_frags = mf->m_nextpkt;
                m_freem(mf);
        }
        m->m_nextpkt = 0;
        r->fr_frags = m;

        return (0);
}

void
firewire_input(struct ifnet *ifp, struct mbuf *m, uint16_t src)
{
        struct fw_com *fc = IFP2FWC(ifp);
        union fw_encap *enc;
        int type, isr;

        /*
         * The caller has already stripped off the packet header
         * (stream or wreqb) and marked the mbuf's M_BCAST flag
         * appropriately. We de-encapsulate the IP packet and pass it
         * up the line after handling link-level fragmentation.
         */
        if (m->m_pkthdr.len < sizeof(uint32_t)) {
                if_printf(ifp, "discarding frame without "
                    "encapsulation header (len %u pkt len %u)\n",
                    m->m_len, m->m_pkthdr.len);
        }

        m = m_pullup(m, sizeof(uint32_t));
        if (m == NULL)
                return;
        enc = mtod(m, union fw_encap *);

        /*
         * Byte swap the encapsulation header manually.
         */
        enc->ul[0] = ntohl(enc->ul[0]);

        if (enc->unfrag.lf != 0) {
                m = m_pullup(m, 2*sizeof(uint32_t));
                if (!m)
                        return;
                enc = mtod(m, union fw_encap *);
                enc->ul[1] = ntohl(enc->ul[1]);
                m = firewire_input_fragment(fc, m, src);
                if (!m)
                        return;
                enc = mtod(m, union fw_encap *);
                type = enc->firstfrag.ether_type;
                m_adj(m, 2*sizeof(uint32_t));
        } else {
                type = enc->unfrag.ether_type;
                m_adj(m, sizeof(uint32_t));
        }

        if (m->m_pkthdr.rcvif == NULL) {
                if_printf(ifp, "discard frame w/o interface pointer\n");
                if_inc_counter(ifp, IFCOUNTER_IERRORS, 1);
                m_freem(m);
                return;
        }
#ifdef DIAGNOSTIC
        if (m->m_pkthdr.rcvif != ifp) {
                if_printf(ifp, "Warning, frame marked as received on %s\n",
                        m->m_pkthdr.rcvif->if_xname);
        }
#endif

#ifdef MAC
        /*
         * Tag the mbuf with an appropriate MAC label before any other
         * consumers can get to it.
         */
        mac_ifnet_create_mbuf(ifp, m);
#endif

        /*
         * Give bpf a chance at the packet. The link-level driver
         * should have left us a tag with the EUID of the sender.
         */
        if (bpf_peers_present(ifp->if_bpf)) {
                struct fw_bpfhdr h;
                struct m_tag *mtag;

                mtag = m_tag_locate(m, MTAG_FIREWIRE, MTAG_FIREWIRE_SENDER_EUID, 0);
                if (mtag)
                        bcopy(mtag + 1, h.firewire_shost, 8);
                else
                        bcopy(&firewire_broadcastaddr, h.firewire_dhost, 8);
                bcopy(&fc->fc_hwaddr, h.firewire_dhost, 8);
                h.firewire_type = htons(type);
                bpf_mtap2(ifp->if_bpf, &h, sizeof(h), m);
        }

        if (ifp->if_flags & IFF_MONITOR) {
                /*
                 * Interface marked for monitoring; discard packet.
                 */
                m_freem(m);
                return;
        }

        if_inc_counter(ifp, IFCOUNTER_IBYTES, m->m_pkthdr.len);

        /* Discard packet if interface is not up */
        if ((ifp->if_flags & IFF_UP) == 0) {
                m_freem(m);
                return;
        }

        if (m->m_flags & (M_BCAST|M_MCAST))
                if_inc_counter(ifp, IFCOUNTER_IMCASTS, 1);

        switch (type) {
#ifdef INET
        case ETHERTYPE_IP:
                isr = NETISR_IP;
                break;

        case ETHERTYPE_ARP:
        {
                struct arphdr *ah;
                ah = mtod(m, struct arphdr *);

                /*
                 * Adjust the arp packet to insert an empty tha slot.
                 */
                m->m_len += ah->ar_hln;
                m->m_pkthdr.len += ah->ar_hln;
                bcopy(ar_tha(ah), ar_tpa(ah), ah->ar_pln);
                isr = NETISR_ARP;
                break;
        }
#endif

#ifdef INET6
        case ETHERTYPE_IPV6:
                isr = NETISR_IPV6;
                break;
#endif

        default:
                m_freem(m);
                return;
        }

        M_SETFIB(m, ifp->if_fib);
        netisr_dispatch(isr, m);
}

int
firewire_ioctl(struct ifnet *ifp, u_long command, caddr_t data)
{
        struct ifaddr *ifa = (struct ifaddr *) data;
        struct ifreq *ifr = (struct ifreq *) data;
        int error = 0;

        switch (command) {
        case SIOCSIFADDR:
                ifp->if_flags |= IFF_UP;

                switch (ifa->ifa_addr->sa_family) {
#ifdef INET
                case AF_INET:
                        ifp->if_init(ifp->if_softc);    /* before arpwhohas */
                        arp_ifinit(ifp, ifa);
                        break;
#endif
                default:
                        ifp->if_init(ifp->if_softc);
                        break;
                }
                break;

        case SIOCGIFADDR:
                {
                        struct sockaddr *sa;

                        sa = (struct sockaddr *) & ifr->ifr_data;
                        bcopy(&IFP2FWC(ifp)->fc_hwaddr,
                            (caddr_t) sa->sa_data, sizeof(struct fw_hwaddr));
                }
                break;

        case SIOCSIFMTU:
                /*
                 * Set the interface MTU.
                 */
                if (ifr->ifr_mtu > 1500) {
                        error = EINVAL;
                } else {
                        ifp->if_mtu = ifr->ifr_mtu;
                }
                break;
        default:
                error = EINVAL;                 /* XXX netbsd has ENOTTY??? */
                break;
        }
        return (error);
}

static int
firewire_resolvemulti(struct ifnet *ifp, struct sockaddr **llsa,
    struct sockaddr *sa)
{
#ifdef INET
        struct sockaddr_in *sin;
#endif
#ifdef INET6
        struct sockaddr_in6 *sin6;
#endif

        switch(sa->sa_family) {
        case AF_LINK:
                /*
                 * No mapping needed.
                 */
                *llsa = NULL;
                return 0;

#ifdef INET
        case AF_INET:
                sin = (struct sockaddr_in *)sa;
                if (!IN_MULTICAST(ntohl(sin->sin_addr.s_addr)))
                        return EADDRNOTAVAIL;
                *llsa = NULL;
                return 0;
#endif
#ifdef INET6
        case AF_INET6:
                sin6 = (struct sockaddr_in6 *)sa;
                if (IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr)) {
                        /*
                         * An IP6 address of 0 means listen to all
                         * of the Ethernet multicast address used for IP6.
                         * (This is used for multicast routers.)
                         */
                        ifp->if_flags |= IFF_ALLMULTI;
                        *llsa = NULL;
                        return 0;
                }
                if (!IN6_IS_ADDR_MULTICAST(&sin6->sin6_addr))
                        return EADDRNOTAVAIL;
                *llsa = NULL;
                return 0;
#endif

        default:
                /*
                 * Well, the text isn't quite right, but it's the name
                 * that counts...
                 */
                return EAFNOSUPPORT;
        }
}

void
firewire_ifattach(struct ifnet *ifp, struct fw_hwaddr *llc)
{
        struct fw_com *fc = IFP2FWC(ifp);
        struct ifaddr *ifa;
        struct sockaddr_dl *sdl;
        static const char* speeds[] = {
                "S100", "S200", "S400", "S800",
                "S1600", "S3200"
        };

        fc->fc_speed = llc->sspd;
        STAILQ_INIT(&fc->fc_frags);

        ifp->if_addrlen = sizeof(struct fw_hwaddr);
        ifp->if_hdrlen = 0;
        if_attach(ifp);
        ifp->if_mtu = 1500;     /* XXX */
        ifp->if_output = firewire_output;
        ifp->if_resolvemulti = firewire_resolvemulti;
        ifp->if_broadcastaddr = (u_char *) &firewire_broadcastaddr;

        ifa = ifp->if_addr;
        KASSERT(ifa != NULL, ("%s: no lladdr!\n", __func__));
        sdl = (struct sockaddr_dl *)ifa->ifa_addr;
        sdl->sdl_type = IFT_IEEE1394;
        sdl->sdl_alen = ifp->if_addrlen;
        bcopy(llc, LLADDR(sdl), ifp->if_addrlen);

        bpfattach(ifp, DLT_APPLE_IP_OVER_IEEE1394,
            sizeof(struct fw_hwaddr));

        if_printf(ifp, "Firewire address: %8D @ 0x%04x%08x, %s, maxrec %d\n",
            (uint8_t *) &llc->sender_unique_ID_hi, ":",
            ntohs(llc->sender_unicast_FIFO_hi),
            ntohl(llc->sender_unicast_FIFO_lo),
            speeds[llc->sspd],
            (2 << llc->sender_max_rec));
}

void
firewire_ifdetach(struct ifnet *ifp)
{
        bpfdetach(ifp);
        if_detach(ifp);
}

void
firewire_busreset(struct ifnet *ifp)
{
        struct fw_com *fc = IFP2FWC(ifp);
        struct fw_reass *r;
        struct mbuf *m;

        /*
         * Discard any partial datagrams since the host ids may have changed.
         */
        while ((r = STAILQ_FIRST(&fc->fc_frags))) {
                STAILQ_REMOVE_HEAD(&fc->fc_frags, fr_link);
                while (r->fr_frags) {
                        m = r->fr_frags;
                        r->fr_frags = m->m_nextpkt;
                        m_freem(m);
                }
                free(r, M_TEMP);
        }
}

static void *
firewire_alloc(u_char type, struct ifnet *ifp)
{
        struct fw_com   *fc;

        fc = malloc(sizeof(struct fw_com), M_FWCOM, M_WAITOK | M_ZERO);
        fc->fc_ifp = ifp;

        return (fc);
}

static void
firewire_free(void *com, u_char type)
{

        free(com, M_FWCOM);
}

static int
firewire_modevent(module_t mod, int type, void *data)
{

        switch (type) {
        case MOD_LOAD:
                if_register_com_alloc(IFT_IEEE1394,
                    firewire_alloc, firewire_free);
                break;
        case MOD_UNLOAD:
                if_deregister_com_alloc(IFT_IEEE1394);
                break;
        default:
                return (EOPNOTSUPP);
        }

        return (0);
}

static moduledata_t firewire_mod = {
        "if_firewire",
        firewire_modevent,
        0
};

DECLARE_MODULE(if_firewire, firewire_mod, SI_SUB_INIT_IF, SI_ORDER_ANY);
MODULE_VERSION(if_firewire, 1);