/* $OpenBSD: if_bwfm_usb.c,v 1.16 2018/07/17 19:44:38 patrick Exp $ */ /* * Copyright (c) 2010-2016 Broadcom Corporation * Copyright (c) 2016,2017 Patrick Wildt * * Permission to use, copy, modify, and/or distribute this software for any * purpose with or without fee is hereby granted, provided that the above * copyright notice and this permission notice appear in all copies. * * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. */ #include "bpfilter.h" #include #include #include #include #include #include #include #include #if NBPFILTER > 0 #include #endif #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include /* * Various supported device vendors/products. */ static const struct usb_devno bwfm_usbdevs[] = { { USB_VENDOR_BROADCOM, USB_PRODUCT_BROADCOM_BCM43143 }, { USB_VENDOR_BROADCOM, USB_PRODUCT_BROADCOM_BCM43236 }, { USB_VENDOR_BROADCOM, USB_PRODUCT_BROADCOM_BCM43242 }, { USB_VENDOR_BROADCOM, USB_PRODUCT_BROADCOM_BCM43569 }, { USB_VENDOR_BROADCOM, USB_PRODUCT_BROADCOM_BCMFW }, }; #ifdef BWFM_DEBUG #define DPRINTF(x) do { if (bwfm_debug > 0) printf x; } while (0) #define DPRINTFN(n, x) do { if (bwfm_debug >= (n)) printf x; } while (0) static int bwfm_debug = 2; #else #define DPRINTF(x) do { ; } while (0) #define DPRINTFN(n, x) do { ; } while (0) #endif #define DEVNAME(sc) ((sc)->sc_sc.sc_dev.dv_xname) #define BRCMF_POSTBOOT_ID 0xA123 /* ID to detect if dongle * has boot up */ #define TRX_MAGIC 0x30524448 /* "HDR0" */ #define TRX_MAX_OFFSET 3 /* Max number of file offsets */ #define TRX_UNCOMP_IMAGE 0x20 /* Trx holds uncompressed img */ #define TRX_RDL_CHUNK 1500 /* size of each dl transfer */ #define TRX_OFFSETS_DLFWLEN_IDX 0 /* Control messages: bRequest values */ #define DL_GETSTATE 0 /* returns the rdl_state_t struct */ #define DL_CHECK_CRC 1 /* currently unused */ #define DL_GO 2 /* execute downloaded image */ #define DL_START 3 /* initialize dl state */ #define DL_REBOOT 4 /* reboot the device in 2 seconds */ #define DL_GETVER 5 /* returns the bootrom_id_t struct */ #define DL_GO_PROTECTED 6 /* execute the downloaded code and set reset * event to occur in 2 seconds. It is the * responsibility of the downloaded code to * clear this event */ #define DL_EXEC 7 /* jump to a supplied address */ #define DL_RESETCFG 8 /* To support single enum on dongle * - Not used by bootloader */ #define DL_DEFER_RESP_OK 9 /* Potentially defer the response to setup * if resp unavailable */ /* states */ #define DL_WAITING 0 /* waiting to rx first pkt */ #define DL_READY 1 /* hdr was good, waiting for more of the * compressed image */ #define DL_BAD_HDR 2 /* hdr was corrupted */ #define DL_BAD_CRC 3 /* compressed image was corrupted */ #define DL_RUNNABLE 4 /* download was successful,waiting for go cmd */ #define DL_START_FAIL 5 /* failed to initialize correctly */ #define DL_NVRAM_TOOBIG 6 /* host specified nvram data exceeds DL_NVRAM * value */ #define DL_IMAGE_TOOBIG 7 /* firmware image too big */ struct trx_header { uint32_t magic; /* "HDR0" */ uint32_t len; /* Length of file including header */ uint32_t crc32; /* CRC from flag_version to end of file */ uint32_t flag_version; /* 0:15 flags, 16:31 version */ uint32_t offsets[TRX_MAX_OFFSET];/* Offsets of partitions from start of * header */ }; struct rdl_state { uint32_t state; uint32_t bytes; }; struct bootrom_id { uint32_t chip; /* Chip id */ uint32_t chiprev; /* Chip rev */ uint32_t ramsize; /* Size of RAM */ uint32_t remapbase; /* Current remap base address */ uint32_t boardtype; /* Type of board */ uint32_t boardrev; /* Board revision */ }; struct bwfm_usb_rx_data { struct bwfm_usb_softc *sc; struct usbd_xfer *xfer; uint8_t *buf; }; struct bwfm_usb_tx_data { struct bwfm_usb_softc *sc; struct usbd_xfer *xfer; uint8_t *buf; struct mbuf *mbuf; TAILQ_ENTRY(bwfm_usb_tx_data) next; }; #define BWFM_RX_LIST_COUNT 50 #define BWFM_TX_LIST_COUNT 50 #define BWFM_RXBUFSZ 1600 #define BWFM_TXBUFSZ 1600 struct bwfm_usb_softc { struct bwfm_softc sc_sc; struct usbd_device *sc_udev; struct usbd_interface *sc_iface; uint8_t sc_ifaceno; int sc_initialized; uint16_t sc_vendor; uint16_t sc_product; uint32_t sc_chip; uint32_t sc_chiprev; int sc_rx_no; int sc_tx_no; struct usbd_pipe *sc_rx_pipeh; struct usbd_pipe *sc_tx_pipeh; struct bwfm_usb_rx_data sc_rx_data[BWFM_RX_LIST_COUNT]; struct bwfm_usb_tx_data sc_tx_data[BWFM_TX_LIST_COUNT]; TAILQ_HEAD(, bwfm_usb_tx_data) sc_tx_free_list; }; int bwfm_usb_match(struct device *, void *, void *); void bwfm_usb_attach(struct device *, struct device *, void *); int bwfm_usb_detach(struct device *, int); int bwfm_usb_dl_cmd(struct bwfm_usb_softc *, uint8_t, void *, int); int bwfm_usb_load_microcode(struct bwfm_usb_softc *, const u_char *, size_t); int bwfm_usb_alloc_rx_list(struct bwfm_usb_softc *); void bwfm_usb_free_rx_list(struct bwfm_usb_softc *); int bwfm_usb_alloc_tx_list(struct bwfm_usb_softc *); void bwfm_usb_free_tx_list(struct bwfm_usb_softc *); int bwfm_usb_preinit(struct bwfm_softc *); int bwfm_usb_txcheck(struct bwfm_softc *); int bwfm_usb_txdata(struct bwfm_softc *, struct mbuf *); int bwfm_usb_txctl(struct bwfm_softc *, void *); void bwfm_usb_txctl_cb(struct usbd_xfer *, void *, usbd_status); struct mbuf * bwfm_usb_newbuf(void); void bwfm_usb_rxeof(struct usbd_xfer *, void *, usbd_status); void bwfm_usb_txeof(struct usbd_xfer *, void *, usbd_status); struct bwfm_bus_ops bwfm_usb_bus_ops = { .bs_preinit = bwfm_usb_preinit, .bs_stop = NULL, .bs_txcheck = bwfm_usb_txcheck, .bs_txdata = bwfm_usb_txdata, .bs_txctl = bwfm_usb_txctl, }; struct cfattach bwfm_usb_ca = { sizeof(struct bwfm_usb_softc), bwfm_usb_match, bwfm_usb_attach, bwfm_usb_detach, }; int bwfm_usb_match(struct device *parent, void *match, void *aux) { struct usb_attach_arg *uaa = aux; if (uaa->iface == NULL || uaa->configno != 1) return UMATCH_NONE; return (usb_lookup(bwfm_usbdevs, uaa->vendor, uaa->product) != NULL) ? UMATCH_VENDOR_PRODUCT_CONF_IFACE : UMATCH_NONE; } void bwfm_usb_attach(struct device *parent, struct device *self, void *aux) { struct bwfm_usb_softc *sc = (struct bwfm_usb_softc *)self; struct usb_attach_arg *uaa = aux; usb_device_descriptor_t *dd; usb_interface_descriptor_t *id; usb_endpoint_descriptor_t *ed; int i; sc->sc_udev = uaa->device; sc->sc_iface = uaa->iface; sc->sc_ifaceno = uaa->ifaceno; sc->sc_vendor = uaa->vendor; sc->sc_product = uaa->product; sc->sc_sc.sc_bus_ops = &bwfm_usb_bus_ops; sc->sc_sc.sc_proto_ops = &bwfm_proto_bcdc_ops; /* Check number of configurations. */ dd = usbd_get_device_descriptor(sc->sc_udev); if (dd->bNumConfigurations != 1) { printf("%s: number of configurations not supported\n", DEVNAME(sc)); return; } /* Get endpoints. */ id = usbd_get_interface_descriptor(sc->sc_iface); sc->sc_rx_no = sc->sc_tx_no = -1; for (i = 0; i < id->bNumEndpoints; i++) { ed = usbd_interface2endpoint_descriptor(sc->sc_iface, i); if (ed == NULL) { printf("%s: no endpoint descriptor for iface %d\n", DEVNAME(sc), i); return; } if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN && UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK && sc->sc_rx_no == -1) sc->sc_rx_no = ed->bEndpointAddress; else if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_OUT && UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK && sc->sc_tx_no == -1) sc->sc_tx_no = ed->bEndpointAddress; } if (sc->sc_rx_no == -1 || sc->sc_tx_no == -1) { printf("%s: missing endpoint\n", DEVNAME(sc)); return; } bwfm_attach(&sc->sc_sc); config_mountroot(self, bwfm_attachhook); } int bwfm_usb_preinit(struct bwfm_softc *bwfm) { struct bwfm_usb_softc *sc = (void *)bwfm; struct bwfm_usb_rx_data *data; const char *name = NULL; struct bootrom_id brom; usbd_status error; u_char *ucode; size_t size; int i; if (sc->sc_initialized) return 0; /* Read chip id and chip rev to check the firmware. */ memset(&brom, 0, sizeof(brom)); bwfm_usb_dl_cmd(sc, DL_GETVER, &brom, sizeof(brom)); sc->sc_chip = letoh32(brom.chip); sc->sc_chiprev = letoh32(brom.chiprev); /* Setup data pipes */ error = usbd_open_pipe(sc->sc_iface, sc->sc_rx_no, USBD_EXCLUSIVE_USE, &sc->sc_rx_pipeh); if (error != 0) { printf("%s: could not open rx pipe: %s\n", DEVNAME(sc), usbd_errstr(error)); return 1; } error = usbd_open_pipe(sc->sc_iface, sc->sc_tx_no, USBD_EXCLUSIVE_USE, &sc->sc_tx_pipeh); if (error != 0) { printf("%s: could not open tx pipe: %s\n", DEVNAME(sc), usbd_errstr(error)); goto cleanup; } /* Firmware not yet loaded? */ if (sc->sc_chip != BRCMF_POSTBOOT_ID) { switch (sc->sc_chip) { case BRCM_CC_43143_CHIP_ID: name = "brcmfmac43143.bin"; break; case BRCM_CC_43235_CHIP_ID: case BRCM_CC_43236_CHIP_ID: case BRCM_CC_43238_CHIP_ID: if (sc->sc_chiprev == 3) name = "brcmfmac43236b.bin"; break; case BRCM_CC_43242_CHIP_ID: name = "brcmfmac43242a.bin"; break; case BRCM_CC_43566_CHIP_ID: case BRCM_CC_43569_CHIP_ID: name = "brcmfmac43569.bin"; break; default: break; } if (name == NULL) { printf("%s: unknown firmware\n", DEVNAME(sc)); goto cleanup; } if (loadfirmware(name, &ucode, &size) != 0) { printf("%s: failed loadfirmware of file %s\n", DEVNAME(sc), name); goto cleanup; } if (bwfm_usb_load_microcode(sc, ucode, size) != 0) { printf("%s: could not load microcode\n", DEVNAME(sc)); free(ucode, M_DEVBUF, size); goto cleanup; } free(ucode, M_DEVBUF, size); for (i = 0; i < 10; i++) { delay(100 * 1000); memset(&brom, 0, sizeof(brom)); bwfm_usb_dl_cmd(sc, DL_GETVER, &brom, sizeof(brom)); if (letoh32(brom.chip) == BRCMF_POSTBOOT_ID) break; } if (letoh32(brom.chip) != BRCMF_POSTBOOT_ID) { printf("%s: firmware did not start up\n", DEVNAME(sc)); goto cleanup; } sc->sc_chip = letoh32(brom.chip); sc->sc_chiprev = letoh32(brom.chiprev); } bwfm_usb_dl_cmd(sc, DL_RESETCFG, &brom, sizeof(brom)); if (bwfm_usb_alloc_rx_list(sc) || bwfm_usb_alloc_tx_list(sc)) { printf("%s: cannot allocate rx/tx lists\n", DEVNAME(sc)); goto cleanup; } for (i = 0; i < BWFM_RX_LIST_COUNT; i++) { data = &sc->sc_rx_data[i]; usbd_setup_xfer(data->xfer, sc->sc_rx_pipeh, data, data->buf, BWFM_RXBUFSZ, USBD_SHORT_XFER_OK | USBD_NO_COPY, USBD_NO_TIMEOUT, bwfm_usb_rxeof); error = usbd_transfer(data->xfer); if (error != 0 && error != USBD_IN_PROGRESS) printf("%s: could not set up new transfer: %s\n", DEVNAME(sc), usbd_errstr(error)); } sc->sc_initialized = 1; return 0; cleanup: if (sc->sc_rx_pipeh) { usbd_abort_pipe(sc->sc_rx_pipeh); usbd_close_pipe(sc->sc_rx_pipeh); sc->sc_rx_pipeh = NULL; } if (sc->sc_tx_pipeh) { usbd_abort_pipe(sc->sc_tx_pipeh); usbd_close_pipe(sc->sc_tx_pipeh); sc->sc_tx_pipeh = NULL; } bwfm_usb_free_rx_list(sc); bwfm_usb_free_tx_list(sc); return 1; } struct mbuf * bwfm_usb_newbuf(void) { struct mbuf *m; MGETHDR(m, M_DONTWAIT, MT_DATA); if (m == NULL) return (NULL); MCLGET(m, M_DONTWAIT); if (!(m->m_flags & M_EXT)) { m_freem(m); return (NULL); } m->m_len = m->m_pkthdr.len = MCLBYTES; return (m); } void bwfm_usb_rxeof(struct usbd_xfer *xfer, void *priv, usbd_status status) { struct bwfm_usb_rx_data *data = priv; struct bwfm_usb_softc *sc = data->sc; usbd_status error; struct mbuf *m; uint32_t len; DPRINTFN(2, ("%s: %s status %s\n", DEVNAME(sc), __func__, usbd_errstr(status))); if (usbd_is_dying(sc->sc_udev)) return; if (__predict_false(status != USBD_NORMAL_COMPLETION)) { usbd_clear_endpoint_stall_async(sc->sc_rx_pipeh); if (status != USBD_CANCELLED) goto resubmit; return; } usbd_get_xfer_status(xfer, NULL, NULL, &len, NULL); m = bwfm_usb_newbuf(); if (m == NULL) goto resubmit; memcpy(mtod(m, char *), data->buf, len); m->m_len = m->m_pkthdr.len = len; sc->sc_sc.sc_proto_ops->proto_rx(&sc->sc_sc, m); resubmit: usbd_setup_xfer(data->xfer, sc->sc_rx_pipeh, data, data->buf, BWFM_RXBUFSZ, USBD_SHORT_XFER_OK | USBD_NO_COPY, USBD_NO_TIMEOUT, bwfm_usb_rxeof); error = usbd_transfer(data->xfer); if (error != 0 && error != USBD_IN_PROGRESS) printf("%s: could not set up new transfer: %s\n", DEVNAME(sc), usbd_errstr(error)); } int bwfm_usb_alloc_rx_list(struct bwfm_usb_softc *sc) { struct bwfm_usb_rx_data *data; int i, error = 0; for (i = 0; i < BWFM_RX_LIST_COUNT; i++) { data = &sc->sc_rx_data[i]; data->sc = sc; /* Backpointer for callbacks. */ data->xfer = usbd_alloc_xfer(sc->sc_udev); if (data->xfer == NULL) { printf("%s: could not allocate xfer\n", DEVNAME(sc)); error = ENOMEM; break; } data->buf = usbd_alloc_buffer(data->xfer, BWFM_RXBUFSZ); if (data->buf == NULL) { printf("%s: could not allocate xfer buffer\n", DEVNAME(sc)); error = ENOMEM; break; } } if (error != 0) bwfm_usb_free_rx_list(sc); return (error); } void bwfm_usb_free_rx_list(struct bwfm_usb_softc *sc) { int i; /* NB: Caller must abort pipe first. */ for (i = 0; i < BWFM_RX_LIST_COUNT; i++) { if (sc->sc_rx_data[i].xfer != NULL) usbd_free_xfer(sc->sc_rx_data[i].xfer); sc->sc_rx_data[i].xfer = NULL; } } int bwfm_usb_alloc_tx_list(struct bwfm_usb_softc *sc) { struct bwfm_usb_tx_data *data; int i, error = 0; TAILQ_INIT(&sc->sc_tx_free_list); for (i = 0; i < BWFM_TX_LIST_COUNT; i++) { data = &sc->sc_tx_data[i]; data->sc = sc; /* Backpointer for callbacks. */ data->xfer = usbd_alloc_xfer(sc->sc_udev); if (data->xfer == NULL) { printf("%s: could not allocate xfer\n", DEVNAME(sc)); error = ENOMEM; break; } data->buf = usbd_alloc_buffer(data->xfer, BWFM_TXBUFSZ); if (data->buf == NULL) { printf("%s: could not allocate xfer buffer\n", DEVNAME(sc)); error = ENOMEM; break; } /* Append this Tx buffer to our free list. */ TAILQ_INSERT_TAIL(&sc->sc_tx_free_list, data, next); } if (error != 0) bwfm_usb_free_tx_list(sc); return (error); } void bwfm_usb_free_tx_list(struct bwfm_usb_softc *sc) { int i; /* NB: Caller must abort pipe first. */ for (i = 0; i < BWFM_TX_LIST_COUNT; i++) { if (sc->sc_tx_data[i].xfer != NULL) usbd_free_xfer(sc->sc_tx_data[i].xfer); sc->sc_tx_data[i].xfer = NULL; } } void bwfm_usb_txeof(struct usbd_xfer *xfer, void *priv, usbd_status status) { struct bwfm_usb_tx_data *data = priv; struct bwfm_usb_softc *sc = data->sc; struct ifnet *ifp = &sc->sc_sc.sc_ic.ic_if; int s; DPRINTFN(2, ("%s: %s status %s\n", DEVNAME(sc), __func__, usbd_errstr(status))); if (usbd_is_dying(sc->sc_udev)) return; s = splnet(); /* Put this Tx buffer back to our free list. */ TAILQ_INSERT_TAIL(&sc->sc_tx_free_list, data, next); if (__predict_false(status != USBD_NORMAL_COMPLETION)) { if (status == USBD_CANCELLED) usbd_clear_endpoint_stall_async(sc->sc_tx_pipeh); ifp->if_oerrors++; splx(s); return; } m_freem(data->mbuf); data->mbuf = NULL; /* We just released a Tx buffer, notify Tx. */ if (ifq_is_oactive(&ifp->if_snd)) { ifq_restart(&ifp->if_snd); } splx(s); } int bwfm_usb_detach(struct device *self, int flags) { struct bwfm_usb_softc *sc = (struct bwfm_usb_softc *)self; bwfm_detach(&sc->sc_sc, flags); if (sc->sc_rx_pipeh != NULL) { usbd_abort_pipe(sc->sc_rx_pipeh); usbd_close_pipe(sc->sc_rx_pipeh); } if (sc->sc_tx_pipeh != NULL) { usbd_abort_pipe(sc->sc_tx_pipeh); usbd_close_pipe(sc->sc_tx_pipeh); } bwfm_usb_free_rx_list(sc); bwfm_usb_free_tx_list(sc); return 0; } int bwfm_usb_dl_cmd(struct bwfm_usb_softc *sc, uByte cmd, void *buf, int len) { usb_device_request_t req; usbd_status error; req.bmRequestType = UT_READ_VENDOR_INTERFACE; req.bRequest = cmd; USETW(req.wValue, 0); USETW(req.wIndex, sc->sc_ifaceno); USETW(req.wLength, len); error = usbd_do_request(sc->sc_udev, &req, buf); if (error != 0) { printf("%s: could not read register: %s\n", DEVNAME(sc), usbd_errstr(error)); } return error; } int bwfm_usb_load_microcode(struct bwfm_usb_softc *sc, const u_char *ucode, size_t size) { struct trx_header *trx = (struct trx_header *)ucode; struct rdl_state state; uint32_t rdlstate, rdlbytes, sent = 0, sendlen = 0; struct usbd_xfer *xfer; usbd_status error; char *buf; if (letoh32(trx->magic) != TRX_MAGIC || (letoh32(trx->flag_version) & TRX_UNCOMP_IMAGE) == 0) { printf("%s: invalid firmware\n", DEVNAME(sc)); return 1; } bwfm_usb_dl_cmd(sc, DL_START, &state, sizeof(state)); rdlstate = letoh32(state.state); rdlbytes = letoh32(state.bytes); if (rdlstate != DL_WAITING) { printf("%s: cannot start fw download\n", DEVNAME(sc)); return 1; } xfer = usbd_alloc_xfer(sc->sc_udev); if (xfer == NULL) { printf("%s: cannot alloc xfer\n", DEVNAME(sc)); goto err; } buf = usbd_alloc_buffer(xfer, TRX_RDL_CHUNK); if (buf == NULL) { printf("%s: cannot alloc buf\n", DEVNAME(sc)); goto err; } while (rdlbytes != size) { sendlen = MIN(size - sent, TRX_RDL_CHUNK); memcpy(buf, ucode + sent, sendlen); usbd_setup_xfer(xfer, sc->sc_tx_pipeh, NULL, buf, sendlen, USBD_SYNCHRONOUS | USBD_NO_COPY, USBD_NO_TIMEOUT, NULL); error = usbd_transfer(xfer); if (error != 0 && error != USBD_IN_PROGRESS) { printf("%s: transfer error\n", DEVNAME(sc)); goto err; } sent += sendlen; bwfm_usb_dl_cmd(sc, DL_GETSTATE, &state, sizeof(state)); rdlstate = letoh32(state.state); rdlbytes = letoh32(state.bytes); if (rdlbytes != sent) { printf("%s: device reported different size\n", DEVNAME(sc)); goto err; } if (rdlstate == DL_BAD_HDR || rdlstate == DL_BAD_CRC) { printf("%s: device reported bad hdr/crc\n", DEVNAME(sc)); goto err; } } bwfm_usb_dl_cmd(sc, DL_GETSTATE, &state, sizeof(state)); rdlstate = letoh32(state.state); rdlbytes = letoh32(state.bytes); if (rdlstate != DL_RUNNABLE) { printf("%s: dongle not runnable\n", DEVNAME(sc)); goto err; } bwfm_usb_dl_cmd(sc, DL_GO, &state, sizeof(state)); return 0; err: if (sc->sc_tx_pipeh != NULL) { usbd_abort_pipe(sc->sc_tx_pipeh); usbd_close_pipe(sc->sc_tx_pipeh); sc->sc_tx_pipeh = NULL; } if (xfer != NULL) usbd_free_xfer(xfer); return 1; } int bwfm_usb_txcheck(struct bwfm_softc *bwfm) { struct bwfm_usb_softc *sc = (void *)bwfm; if (TAILQ_EMPTY(&sc->sc_tx_free_list)) return ENOBUFS; return 0; } int bwfm_usb_txdata(struct bwfm_softc *bwfm, struct mbuf *m) { struct bwfm_usb_softc *sc = (void *)bwfm; struct bwfm_proto_bcdc_hdr *hdr; struct bwfm_usb_tx_data *data; uint32_t len = 0; int error; DPRINTFN(2, ("%s: %s\n", DEVNAME(sc), __func__)); if (TAILQ_EMPTY(&sc->sc_tx_free_list)) return ENOBUFS; /* Grab a Tx buffer from our free list. */ data = TAILQ_FIRST(&sc->sc_tx_free_list); TAILQ_REMOVE(&sc->sc_tx_free_list, data, next); hdr = (void *)&data->buf[len]; hdr->data_offset = 0; hdr->priority = ieee80211_classify(&sc->sc_sc.sc_ic, m); hdr->flags = BWFM_BCDC_FLAG_VER(BWFM_BCDC_FLAG_PROTO_VER); hdr->flags2 = 0; len += sizeof(*hdr); m_copydata(m, 0, m->m_pkthdr.len, (caddr_t)&data->buf[len]); len += m->m_pkthdr.len; data->mbuf = m; usbd_setup_xfer(data->xfer, sc->sc_tx_pipeh, data, data->buf, len, USBD_FORCE_SHORT_XFER | USBD_NO_COPY, USBD_NO_TIMEOUT, bwfm_usb_txeof); error = usbd_transfer(data->xfer); if (error != 0 && error != USBD_IN_PROGRESS) printf("%s: could not set up new transfer: %s\n", DEVNAME(sc), usbd_errstr(error)); return 0; } int bwfm_usb_txctl(struct bwfm_softc *bwfm, void *arg) { struct bwfm_usb_softc *sc = (void *)bwfm; struct bwfm_proto_bcdc_ctl *ctl = arg; usb_device_request_t req; struct usbd_xfer *xfer; usbd_status error; char *buf; DPRINTFN(2, ("%s: %s\n", DEVNAME(sc), __func__)); /* Send out control packet. */ req.bmRequestType = UT_WRITE_CLASS_INTERFACE; req.bRequest = 0; USETW(req.wValue, 0); USETW(req.wIndex, sc->sc_ifaceno); USETW(req.wLength, ctl->len); error = usbd_do_request(sc->sc_udev, &req, ctl->buf); if (error != 0) { printf("%s: could not write ctl packet: %s\n", DEVNAME(sc), usbd_errstr(error)); free(ctl->buf, M_TEMP, ctl->len); free(ctl, M_TEMP, sizeof(*ctl)); return 1; } /* Setup asynchronous receive. */ if ((xfer = usbd_alloc_xfer(sc->sc_udev)) == NULL) { free(ctl->buf, M_TEMP, ctl->len); free(ctl, M_TEMP, sizeof(*ctl)); return 1; } if ((buf = usbd_alloc_buffer(xfer, ctl->len)) == NULL) { free(ctl->buf, M_TEMP, ctl->len); free(ctl, M_TEMP, sizeof(*ctl)); usbd_free_xfer(xfer); return 1; } memset(buf, 0, ctl->len); req.bmRequestType = UT_READ_CLASS_INTERFACE; req.bRequest = 1; USETW(req.wValue, 0); USETW(req.wIndex, sc->sc_ifaceno); USETW(req.wLength, ctl->len); error = usbd_request_async(xfer, &req, sc, bwfm_usb_txctl_cb); if (error != 0) { printf("%s: could not read ctl packet: %s\n", DEVNAME(sc), usbd_errstr(error)); free(ctl->buf, M_TEMP, ctl->len); free(ctl, M_TEMP, sizeof(*ctl)); usbd_free_xfer(xfer); return 1; } TAILQ_INSERT_TAIL(&sc->sc_sc.sc_bcdc_rxctlq, ctl, next); return 0; } void bwfm_usb_txctl_cb(struct usbd_xfer *xfer, void *priv, usbd_status err) { struct bwfm_usb_softc *sc = priv; if (usbd_is_dying(xfer->pipe->device)) goto err; if (err == USBD_NORMAL_COMPLETION || err == USBD_SHORT_XFER) { sc->sc_sc.sc_proto_ops->proto_rxctl(&sc->sc_sc, KERNADDR(&xfer->dmabuf, 0), xfer->actlen); } err: usbd_free_xfer(xfer); }