diff options
author | 2009-03-23 21:53:57 +0000 | |
---|---|---|
committer | 2009-03-23 21:53:57 +0000 | |
commit | 68baf11c75c00885f8f3e9bab214dfba61d41109 (patch) | |
tree | 74b2b56dcefe3a0755e5373262b8c8066c5c6546 /sys/dev/usb/if_otus.c | |
parent | various minor improvements; ok jacekm gilles (diff) | |
download | wireguard-openbsd-68baf11c75c00885f8f3e9bab214dfba61d41109.tar.xz wireguard-openbsd-68baf11c75c00885f8f3e9bab214dfba61d41109.zip |
otus(4), a driver for Atheros AR9001U USB IEEE 802.11 devices.
more work is required but basic operations work.
requires a non-free firmware to operate.
partly based on source code released under the ISC by Atheros
Communications for Linux, although I had to rewrite almost everything
(actually I only used some .h files from the Atheros driver.)
there also exists a rewrite of the Atheros driver for Linux (ar9170)
but the guy decided to make the code less free by wrapping the GPL
around the ISC.
committed over a NETGEAR WNDA3100.
ok deraadt@
Diffstat (limited to 'sys/dev/usb/if_otus.c')
-rw-r--r-- | sys/dev/usb/if_otus.c | 2225 |
1 files changed, 2225 insertions, 0 deletions
diff --git a/sys/dev/usb/if_otus.c b/sys/dev/usb/if_otus.c new file mode 100644 index 00000000000..278c3f32f8c --- /dev/null +++ b/sys/dev/usb/if_otus.c @@ -0,0 +1,2225 @@ +/* $OpenBSD: if_otus.c,v 1.1 2009/03/23 21:53:57 damien Exp $ */ + +/*- + * Copyright (c) 2009 Damien Bergamini <damien.bergamini@free.fr> + * + * Permission to use, copy, modify, and 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. + */ + +/*- + * Driver for Atheros AR9001U chipset. + * http://www.atheros.com/pt/bulletins/AR9001USBBulletin.pdf + */ + +#include "bpfilter.h" + +#include <sys/param.h> +#include <sys/sockio.h> +#include <sys/sysctl.h> +#include <sys/mbuf.h> +#include <sys/kernel.h> +#include <sys/socket.h> +#include <sys/systm.h> +#include <sys/timeout.h> +#include <sys/conf.h> +#include <sys/device.h> + +#include <machine/bus.h> +#include <machine/endian.h> +#include <machine/intr.h> + +#if NBPFILTER > 0 +#include <net/bpf.h> +#endif +#include <net/if.h> +#include <net/if_arp.h> +#include <net/if_dl.h> +#include <net/if_media.h> +#include <net/if_types.h> + +#include <netinet/in.h> +#include <netinet/in_systm.h> +#include <netinet/in_var.h> +#include <netinet/if_ether.h> +#include <netinet/ip.h> + +#include <net80211/ieee80211_var.h> +#include <net80211/ieee80211_amrr.h> +#include <net80211/ieee80211_radiotap.h> + +#include <dev/usb/usb.h> +#include <dev/usb/usbdi.h> +#include <dev/usb/usbdi_util.h> +#include <dev/usb/usbdevs.h> + +#include <dev/usb/if_otusreg.h> + +#ifdef USB_DEBUG +#define OTUS_DEBUG +#endif + +#define OTUS_DEBUG + +#ifdef OTUS_DEBUG +#define DPRINTF(x) do { if (otus_debug) printf x; } while (0) +#define DPRINTFN(n, x) do { if (otus_debug >= (n)) printf x; } while (0) +int otus_debug = 1; +#else +#define DPRINTF(x) +#define DPRINTFN(n, x) +#endif + +static const struct usb_devno otus_devs[] = { + { USB_VENDOR_ACCTON, USB_PRODUCT_ACCTON_WN7512 }, + { USB_VENDOR_ATHEROS2, USB_PRODUCT_ATHEROS2_TG121N }, + { USB_VENDOR_ATHEROS2, USB_PRODUCT_ATHEROS2_AR9170 }, + { USB_VENDOR_DLINK2, USB_PRODUCT_DLINK2_DWA160A }, + { USB_VENDOR_IODATA, USB_PRODUCT_IODATA_WNGDNUS2 }, + { USB_VENDOR_NETGEAR, USB_PRODUCT_NETGEAR_WN111V2 }, + { USB_VENDOR_NETGEAR, USB_PRODUCT_NETGEAR_WNDA3100 }, + { USB_VENDOR_PLANEX2, USB_PRODUCT_PLANEX2_GW_US300 }, + { USB_VENDOR_ZCOM, USB_PRODUCT_ZCOM_UB81 }, + { USB_VENDOR_ZCOM, USB_PRODUCT_ZCOM_UB82 }, + { USB_VENDOR_ZYDAS, USB_PRODUCT_ZYDAS_ZD1221 } +}; + +int otus_match(struct device *, void *, void *); +void otus_attach(struct device *, struct device *, void *); +int otus_detach(struct device *, int); +void otus_attachhook(void *); +void otus_get_chanlist(struct otus_softc *); +int otus_alloc_tx_cmd(struct otus_softc *); +void otus_free_tx_cmd(struct otus_softc *); +int otus_alloc_tx_data_list(struct otus_softc *); +void otus_free_tx_data_list(struct otus_softc *); +int otus_alloc_rx_data_list(struct otus_softc *); +void otus_free_rx_data_list(struct otus_softc *); +int otus_load_firmware(struct otus_softc *, const char *, + uint32_t); +int otus_open_pipes(struct otus_softc *); +void otus_close_pipes(struct otus_softc *); +int otus_cmd(struct otus_softc *, uint8_t, const void *, int, + void *); +void otus_write(struct otus_softc *, uint32_t, uint32_t); +int otus_write_barrier(struct otus_softc *); +void otus_intr(usbd_xfer_handle, usbd_private_handle, usbd_status); +struct ieee80211_node *otus_node_alloc(struct ieee80211com *); +int otus_media_change(struct ifnet *); +void otus_next_scan(void *); +void otus_task(void *); +void otus_do_async(struct otus_softc *, + void (*)(struct otus_softc *, void *), void *, int); +int otus_newstate(struct ieee80211com *, enum ieee80211_state, + int); +void otus_newstate_cb(struct otus_softc *, void *); +int otus_read_eeprom(struct otus_softc *); +void otus_newassoc(struct ieee80211com *, struct ieee80211_node *, + int); +void otus_cmd_rxeof(struct otus_softc *, uint8_t *, int); +void otus_sub_rxeof(struct otus_softc *, uint8_t *, int); +void otus_rxeof(usbd_xfer_handle, usbd_private_handle, usbd_status); +void otus_txeof(usbd_xfer_handle, usbd_private_handle, usbd_status); +int otus_tx(struct otus_softc *, struct mbuf *, + struct ieee80211_node *); +void otus_start(struct ifnet *); +void otus_watchdog(struct ifnet *); +int otus_ioctl(struct ifnet *, u_long, caddr_t); +int otus_set_beacon(struct otus_softc *); +int otus_set_multi(struct otus_softc *); +void otus_updateedca(struct ieee80211com *); +void otus_updateedca_cb(struct otus_softc *, void *); +void otus_updateslot(struct ieee80211com *); +void otus_updateslot_cb(struct otus_softc *, void *); +int otus_init_mac(struct otus_softc *); +uint32_t otus_phy_get_def(struct otus_softc *, uint32_t); +int otus_set_board_values(struct otus_softc *, + struct ieee80211_channel *); +int otus_program_phy(struct otus_softc *, + struct ieee80211_channel *); +void otus_get_delta_slope(uint32_t, uint32_t *, uint32_t *); +int otus_set_chan(struct otus_softc *, struct ieee80211_channel *); +int otus_set_key(struct ieee80211com *, struct ieee80211_node *, + struct ieee80211_key *); +void otus_set_key_cb(struct otus_softc *, void *); +void otus_delete_key(struct ieee80211com *, struct ieee80211_node *, + struct ieee80211_key *); +void otus_delete_key_cb(struct otus_softc *, void *); +void otus_calibrate_to(void *); +int otus_set_bssid(struct otus_softc *, const uint8_t *); +int otus_set_macaddr(struct otus_softc *, const uint8_t *); +void otus_led_newstate_type1(struct otus_softc *); +void otus_led_newstate_type2(struct otus_softc *); +void otus_led_newstate_type3(struct otus_softc *); +int otus_init(struct ifnet *); +void otus_stop(struct ifnet *); + +struct cfdriver otus_cd = { + NULL, "otus", DV_IFNET +}; + +const struct cfattach otus_ca = { + sizeof (struct otus_softc), otus_match, otus_attach, otus_detach +}; + +int +otus_match(struct device *parent, void *match, void *aux) +{ + struct usb_attach_arg *uaa = aux; + + if (uaa->iface != NULL) + return UMATCH_NONE; + + return (usb_lookup(otus_devs, uaa->vendor, uaa->product) != NULL) ? + UMATCH_VENDOR_PRODUCT : UMATCH_NONE; +} + +void +otus_attach(struct device *parent, struct device *self, void *aux) +{ + struct otus_softc *sc = (struct otus_softc *)self; + struct usb_attach_arg *uaa = aux; + int error; + + sc->sc_udev = uaa->device; + + usb_init_task(&sc->sc_task, otus_task, sc); + timeout_set(&sc->scan_to, otus_next_scan, sc); + timeout_set(&sc->calib_to, otus_calibrate_to, sc); + + sc->amrr.amrr_min_success_threshold = 1; + sc->amrr.amrr_max_success_threshold = 10; + + if (usbd_set_config_no(sc->sc_udev, 1, 0) != 0) { + printf("%s: could not set configuration no\n", + sc->sc_dev.dv_xname); + return; + } + + /* Get the first interface handle. */ + error = usbd_device2interface_handle(sc->sc_udev, 0, &sc->sc_iface); + if (error != 0) { + printf("%s: could not get interface handle\n", + sc->sc_dev.dv_xname); + return; + } + + if ((error = otus_open_pipes(sc)) != 0) { + printf("%s: could not open pipes\n", sc->sc_dev.dv_xname); + return; + } + + if (rootvp == NULL) + mountroothook_establish(otus_attachhook, sc); + else + otus_attachhook(sc); + + usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH, sc->sc_udev, &sc->sc_dev); +} + +int +otus_detach(struct device *self, int flags) +{ + struct otus_softc *sc = (struct otus_softc *)self; + struct ifnet *ifp = &sc->sc_ic.ic_if; + int s; + + s = splnet(); + + /* Wait for all queued asynchronous commands to complete. */ + while (sc->cmdq.queued > 0) + tsleep(&sc->cmdq, 0, "cmdq", 0); + + timeout_del(&sc->scan_to); + timeout_del(&sc->calib_to); + + if (ifp->if_flags != 0) { /* if_attach() has been called */ + ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE); + ieee80211_ifdetach(ifp); + if_detach(ifp); + } + + otus_close_pipes(sc); + + splx(s); + + usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev, &sc->sc_dev); + + return 0; +} + +void +otus_attachhook(void *xsc) +{ + struct otus_softc *sc = xsc; + struct ieee80211com *ic = &sc->sc_ic; + struct ifnet *ifp = &ic->ic_if; + usb_device_request_t req; + uint32_t in, out; + int error; + + error = otus_load_firmware(sc, "otus-init", AR_FW_INIT_ADDR); + if (error != 0) { + printf("%s: could not load %s firmware\n", + sc->sc_dev.dv_xname, "init"); + return; + } + + usbd_delay_ms(sc->sc_udev, 1000); + + error = otus_load_firmware(sc, "otus-main", AR_FW_MAIN_ADDR); + if (error != 0) { + printf("%s: could not load %s firmware\n", + sc->sc_dev.dv_xname, "main"); + return; + } + + /* Tell device that firmware transfer is complete. */ + req.bmRequestType = UT_WRITE_VENDOR_DEVICE; + req.bRequest = AR_FW_DOWNLOAD_COMPLETE; + USETW(req.wValue, 0); + USETW(req.wIndex, 0); + USETW(req.wLength, 0); + if (usbd_do_request(sc->sc_udev, &req, NULL) != 0) { + printf("%s: firmware initialization failed\n", + sc->sc_dev.dv_xname); + return; + } + + /* Send an ECHO command to check that everything is settled. */ + in = 0xbadc0ffe; + if (otus_cmd(sc, AR_CMD_ECHO, &in, sizeof in, &out) != 0) { + printf("%s: echo command failed\n", sc->sc_dev.dv_xname); + return; + } + if (in != out) { + printf("%s: echo reply mismatch\n", sc->sc_dev.dv_xname); + return; + } + + /* Read entire EEPROM. */ + if (otus_read_eeprom(sc) != 0) { + printf("%s: could not read EEPROM\n", sc->sc_dev.dv_xname); + return; + } + + IEEE80211_ADDR_COPY(ic->ic_myaddr, sc->eeprom.baseEepHeader.macAddr); + +/* XXX */ + sc->sc_led_newstate = otus_led_newstate_type3; + + printf("%s: address %s\n", sc->sc_dev.dv_xname, + ether_sprintf(ic->ic_myaddr)); + + ic->ic_phytype = IEEE80211_T_OFDM; /* not only, but not used */ + ic->ic_opmode = IEEE80211_M_STA; /* default to BSS mode */ + ic->ic_state = IEEE80211_S_INIT; + + /* Set device capabilities. */ + ic->ic_caps = + IEEE80211_C_MONITOR | /* monitor mode supported */ + IEEE80211_C_SHPREAMBLE | /* short preamble supported */ + IEEE80211_C_SHSLOT | /* short slot time supported */ + IEEE80211_C_WEP | /* WEP */ + IEEE80211_C_RSN; /* WPA/RSN */ + + /* Set supported .11b and .11g rates. */ + ic->ic_sup_rates[IEEE80211_MODE_11B] = ieee80211_std_rateset_11b; + ic->ic_sup_rates[IEEE80211_MODE_11G] = ieee80211_std_rateset_11g; + + /* Build the list of supported channels. */ + otus_get_chanlist(sc); + + ifp->if_softc = sc; + ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST; + ifp->if_init = otus_init; + ifp->if_ioctl = otus_ioctl; + ifp->if_start = otus_start; + ifp->if_watchdog = otus_watchdog; + IFQ_SET_READY(&ifp->if_snd); + memcpy(ifp->if_xname, sc->sc_dev.dv_xname, IFNAMSIZ); + + if_attach(ifp); + ieee80211_ifattach(ifp); + ic->ic_node_alloc = otus_node_alloc; + ic->ic_newassoc = otus_newassoc; + ic->ic_updateslot = otus_updateslot; + ic->ic_updateedca = otus_updateedca; +#ifdef notyet + ic->ic_set_key = otus_set_key; + ic->ic_delete_key = otus_delete_key; +#endif + /* Override state transition machine. */ + sc->sc_newstate = ic->ic_newstate; + ic->ic_newstate = otus_newstate; + ieee80211_media_init(ifp, otus_media_change, ieee80211_media_status); + +#if NBPFILTER > 0 + bpfattach(&sc->sc_drvbpf, ifp, DLT_IEEE802_11_RADIO, + sizeof (struct ieee80211_frame) + IEEE80211_RADIOTAP_HDRLEN); + + sc->sc_rxtap_len = sizeof sc->sc_rxtapu; + sc->sc_rxtap.wr_ihdr.it_len = htole16(sc->sc_rxtap_len); + sc->sc_rxtap.wr_ihdr.it_present = htole32(OTUS_RX_RADIOTAP_PRESENT); + + sc->sc_txtap_len = sizeof sc->sc_txtapu; + sc->sc_txtap.wt_ihdr.it_len = htole16(sc->sc_txtap_len); + sc->sc_txtap.wt_ihdr.it_present = htole32(OTUS_TX_RADIOTAP_PRESENT); +#endif +} + +void +otus_get_chanlist(struct otus_softc *sc) +{ + struct ieee80211com *ic = &sc->sc_ic; + uint16_t domain; + uint8_t chan; + int i; + + /* XXX regulatory domain. */ + domain = letoh16(sc->eeprom.baseEepHeader.regDmn[0]); + DPRINTF(("regdomain=0x%04x\n", domain)); + + if (sc->eeprom.baseEepHeader.opCapFlags & AR5416_OPFLAGS_11G) { + for (i = 0; i < 14; i++) { + chan = ar_chans[i]; + ic->ic_channels[chan].ic_freq = + ieee80211_ieee2mhz(chan, IEEE80211_CHAN_2GHZ); + ic->ic_channels[chan].ic_flags = + IEEE80211_CHAN_CCK | IEEE80211_CHAN_OFDM | + IEEE80211_CHAN_DYN | IEEE80211_CHAN_2GHZ; + } + } + if (sc->eeprom.baseEepHeader.opCapFlags & AR5416_OPFLAGS_11A) { + for (i = 14; i < nitems(ar_chans); i++) { + chan = ar_chans[i]; + ic->ic_channels[chan].ic_freq = + ieee80211_ieee2mhz(chan, IEEE80211_CHAN_5GHZ); + ic->ic_channels[chan].ic_flags = IEEE80211_CHAN_A; + } + } +} + +int +otus_load_firmware(struct otus_softc *sc, const char *name, uint32_t addr) +{ + usb_device_request_t req; + size_t size; + u_char *fw, *ptr; + int mlen, error; + + /* Read firmware image from the filesystem. */ + if ((error = loadfirmware(name, &fw, &size)) != 0) { + printf("%s: failed loadfirmware of file %s (error %d)\n", + sc->sc_dev.dv_xname, name, error); + return error; + } + req.bmRequestType = UT_WRITE_VENDOR_DEVICE; + req.bRequest = AR_FW_DOWNLOAD; + USETW(req.wIndex, 0); + + ptr = fw; + addr >>= 8; + while (size > 0) { + mlen = MIN(size, 4096); + + USETW(req.wValue, addr); + USETW(req.wLength, mlen); + if (usbd_do_request(sc->sc_udev, &req, ptr) != 0) { + error = EIO; + break; + } + addr += mlen >> 8; + ptr += mlen; + size -= mlen; + } + free(fw, M_DEVBUF); + return error; +} + +int +otus_open_pipes(struct otus_softc *sc) +{ + usb_endpoint_descriptor_t *ed; + int i, isize, error; + + error = usbd_open_pipe(sc->sc_iface, AR_EPT_BULK_RX_NO, 0, + &sc->data_rx_pipe); + if (error != 0) { + printf("%s: could not open Rx bulk pipe\n", + sc->sc_dev.dv_xname); + goto fail; + } + + ed = usbd_get_endpoint_descriptor(sc->sc_iface, AR_EPT_INTR_RX_NO); + if (ed == NULL) { + printf("%s: could not retrieve Rx intr pipe descriptor\n", + sc->sc_dev.dv_xname); + goto fail; + } + isize = UGETW(ed->wMaxPacketSize); + if (isize == 0) { + printf("%s: invalid Rx intr pipe descriptor\n", + sc->sc_dev.dv_xname); + goto fail; + } + sc->ibuf = malloc(isize, M_USBDEV, M_NOWAIT); + if (sc->ibuf == NULL) { + printf("%s: could not allocate Rx intr buffer\n", + sc->sc_dev.dv_xname); + goto fail; + } + error = usbd_open_pipe_intr(sc->sc_iface, AR_EPT_INTR_RX_NO, + USBD_SHORT_XFER_OK, &sc->cmd_rx_pipe, sc, sc->ibuf, isize, + otus_intr, USBD_DEFAULT_INTERVAL); + if (error != 0) { + printf("%s: could not open Rx intr pipe\n", + sc->sc_dev.dv_xname); + goto fail; + } + + error = usbd_open_pipe(sc->sc_iface, AR_EPT_BULK_TX_NO, 0, + &sc->data_tx_pipe); + if (error != 0) { + printf("%s: could not open Tx bulk pipe\n", + sc->sc_dev.dv_xname); + goto fail; + } + + error = usbd_open_pipe(sc->sc_iface, AR_EPT_INTR_TX_NO, 0, + &sc->cmd_tx_pipe); + if (error != 0) { + printf("%s: could not open Tx intr pipe\n", + sc->sc_dev.dv_xname); + goto fail; + } + + if (otus_alloc_tx_cmd(sc) != 0) { + printf("%s: could not allocate command xfer\n", + sc->sc_dev.dv_xname); + goto fail; + } + + if (otus_alloc_tx_data_list(sc) != 0) { + printf("%s: could not allocate Tx xfers\n", + sc->sc_dev.dv_xname); + goto fail; + } + + if (otus_alloc_rx_data_list(sc) != 0) { + printf("%s: could not allocate Rx xfers\n", + sc->sc_dev.dv_xname); + goto fail; + } + + for (i = 0; i < OTUS_RX_DATA_LIST_COUNT; i++) { + struct otus_rx_data *data = &sc->rx_data[i]; + + usbd_setup_xfer(data->xfer, sc->data_rx_pipe, data, data->buf, + OTUS_RXBUFSZ, USBD_SHORT_XFER_OK | USBD_NO_COPY, + USBD_NO_TIMEOUT, otus_rxeof); + error = usbd_transfer(data->xfer); + if (error != USBD_IN_PROGRESS && error != 0) { + printf("%s: could not queue Rx xfer\n", + sc->sc_dev.dv_xname); + goto fail; + } + } + return 0; + + fail: otus_close_pipes(sc); + return error; +} + +void +otus_close_pipes(struct otus_softc *sc) +{ + if (sc->data_rx_pipe != NULL) + usbd_close_pipe(sc->data_rx_pipe); + if (sc->cmd_rx_pipe != NULL) + usbd_close_pipe(sc->cmd_rx_pipe); + if (sc->ibuf != NULL) + free(sc->ibuf, M_USBDEV); + if (sc->data_tx_pipe != NULL) + usbd_close_pipe(sc->data_tx_pipe); + if (sc->cmd_tx_pipe != NULL) + usbd_close_pipe(sc->cmd_tx_pipe); + + otus_free_tx_cmd(sc); + otus_free_tx_data_list(sc); + otus_free_rx_data_list(sc); +} + +int +otus_alloc_tx_cmd(struct otus_softc *sc) +{ + struct otus_tx_cmd *cmd = &sc->tx_cmd; + + cmd->xfer = usbd_alloc_xfer(sc->sc_udev); + if (cmd->xfer == NULL) { + printf("%s: could not allocate xfer\n", + sc->sc_dev.dv_xname); + return ENOMEM; + } + cmd->buf = usbd_alloc_buffer(cmd->xfer, OTUS_MAX_TXCMDSZ); + if (cmd->buf == NULL) { + printf("%s: could not allocate xfer buffer\n", + sc->sc_dev.dv_xname); + usbd_free_xfer(cmd->xfer); + return ENOMEM; + } + return 0; +} + +void +otus_free_tx_cmd(struct otus_softc *sc) +{ + /* Make sure no transfer is pending. */ + usbd_abort_pipe(sc->cmd_tx_pipe); + + if (sc->tx_cmd.xfer != NULL) + usbd_free_xfer(sc->tx_cmd.xfer); +} + +int +otus_alloc_tx_data_list(struct otus_softc *sc) +{ + struct otus_tx_data *data; + int i, error; + + for (i = 0; i < OTUS_TX_DATA_LIST_COUNT; i++) { + data = &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", + sc->sc_dev.dv_xname); + error = ENOMEM; + goto fail; + } + data->buf = usbd_alloc_buffer(data->xfer, OTUS_TXBUFSZ); + if (data->buf == NULL) { + printf("%s: could not allocate xfer buffer\n", + sc->sc_dev.dv_xname); + error = ENOMEM; + goto fail; + } + } + return 0; + +fail: otus_free_tx_data_list(sc); + return error; +} + +void +otus_free_tx_data_list(struct otus_softc *sc) +{ + int i; + + /* make sure no transfers are pending */ + usbd_abort_pipe(sc->data_tx_pipe); + + for (i = 0; i < OTUS_TX_DATA_LIST_COUNT; i++) + if (sc->tx_data[i].xfer != NULL) + usbd_free_xfer(sc->tx_data[i].xfer); +} + +int +otus_alloc_rx_data_list(struct otus_softc *sc) +{ + struct otus_rx_data *data; + int i, error; + + for (i = 0; i < OTUS_RX_DATA_LIST_COUNT; i++) { + data = &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", + sc->sc_dev.dv_xname); + error = ENOMEM; + goto fail; + } + data->buf = usbd_alloc_buffer(data->xfer, OTUS_RXBUFSZ); + if (data->buf == NULL) { + printf("%s: could not allocate xfer buffer\n", + sc->sc_dev.dv_xname); + error = ENOMEM; + goto fail; + } + } + return 0; + +fail: otus_free_rx_data_list(sc); + return error; +} + +void +otus_free_rx_data_list(struct otus_softc *sc) +{ + int i; + + /* Make sure no transfers are pending. */ + usbd_abort_pipe(sc->data_rx_pipe); + + for (i = 0; i < OTUS_RX_DATA_LIST_COUNT; i++) + if (sc->rx_data[i].xfer != NULL) + usbd_free_xfer(sc->rx_data[i].xfer); +} + +void +otus_next_scan(void *arg) +{ + struct otus_softc *sc = arg; + + if (sc->sc_ic.ic_state == IEEE80211_S_SCAN) + ieee80211_next_scan(&sc->sc_ic.ic_if); +} + +void +otus_task(void *arg) +{ + struct otus_softc *sc = arg; + struct otus_host_cmd_ring *ring = &sc->cmdq; + struct otus_host_cmd *cmd; + int s; + + /* Process host commands. */ + s = splusb(); + while (ring->next != ring->cur) { + cmd = &ring->cmd[ring->next]; + splx(s); + /* Callback. */ + cmd->cb(sc, cmd->data); + s = splusb(); + ring->queued--; + ring->next = (ring->next + 1) % OTUS_HOST_CMD_RING_COUNT; + } + wakeup(ring); + splx(s); +} + +void +otus_do_async(struct otus_softc *sc, void (*cb)(struct otus_softc *, void *), + void *arg, int len) +{ + struct otus_host_cmd_ring *ring = &sc->cmdq; + struct otus_host_cmd *cmd; + int s; + + s = splusb(); + cmd = &ring->cmd[ring->cur]; + cmd->cb = cb; + KASSERT(len <= sizeof (cmd->data)); + memcpy(cmd->data, arg, len); + ring->cur = (ring->cur + 1) % OTUS_HOST_CMD_RING_COUNT; + + /* If there is no pending command already, schedule a task. */ + if (++ring->queued == 1) + usb_add_task(sc->sc_udev, &sc->sc_task); + splx(s); +} + +int +otus_newstate(struct ieee80211com *ic, enum ieee80211_state nstate, int arg) +{ + struct otus_softc *sc = ic->ic_softc; + struct otus_cmd_newstate cmd; + + /* Do it in a process context. */ + cmd.state = nstate; + cmd.arg = arg; + otus_do_async(sc, otus_newstate_cb, &cmd, sizeof cmd); + return 0; +} + +void +otus_newstate_cb(struct otus_softc *sc, void *arg) +{ + struct otus_cmd_newstate *cmd = arg; + struct ieee80211com *ic = &sc->sc_ic; + struct ieee80211_node *ni; + int s; + + s = splnet(); + + switch (cmd->state) { + case IEEE80211_S_INIT: + break; + + case IEEE80211_S_SCAN: + (void)otus_set_chan(sc, ic->ic_bss->ni_chan); + timeout_add_msec(&sc->scan_to, 200); + break; + + case IEEE80211_S_AUTH: + case IEEE80211_S_ASSOC: + (void)otus_set_chan(sc, ic->ic_bss->ni_chan); + break; + + case IEEE80211_S_RUN: + (void)otus_set_chan(sc, ic->ic_bss->ni_chan); + + ni = ic->ic_bss; + + if (ic->ic_opmode == IEEE80211_M_STA) { + otus_updateslot(ic); + otus_set_bssid(sc, ni->ni_bssid); + + /* Fake a join to init the Tx rate. */ + otus_newassoc(ic, ni, 1); + + /* Start calibration timer. */ + timeout_add_sec(&sc->calib_to, 1); + } + break; + } + + sc->sc_led_newstate(sc); + (void)sc->sc_newstate(ic, cmd->state, cmd->arg); + + splx(s); +} + +int +otus_cmd(struct otus_softc *sc, uint8_t code, const void *idata, int ilen, + void *odata) +{ + struct otus_tx_cmd *cmd = &sc->tx_cmd; + struct ar_cmd_hdr *hdr; + int s, xferlen, error; + + /* Always bulk-out a multiple of 4 bytes. */ + xferlen = (sizeof (*hdr) + ilen + 3) & ~3; + + hdr = (struct ar_cmd_hdr *)cmd->buf; + hdr->code = code; + hdr->len = ilen; + hdr->token = ++cmd->token; /* Don't care about endianness. */ + memcpy((uint8_t *)&hdr[1], idata, ilen); + + DPRINTFN(2, ("sending command code=0x%02x len=%d token=%d\n", + code, ilen, hdr->token)); + + s = splusb(); + cmd->odata = odata; + cmd->done = 0; + + usbd_setup_xfer(cmd->xfer, sc->cmd_tx_pipe, cmd, cmd->buf, xferlen, + USBD_FORCE_SHORT_XFER | USBD_NO_COPY, OTUS_CMD_TIMEOUT, NULL); + error = usbd_sync_transfer(cmd->xfer); + if (error != 0) { + splx(s); + printf("%s: could not send command 0x%x (error=%s)\n", + sc->sc_dev.dv_xname, code, usbd_errstr(error)); + return EIO; + } + if (!cmd->done) + error = tsleep(cmd, PCATCH, "otuscmd", hz); + cmd->odata = NULL; /* In case answer is received too late. */ + splx(s); + if (error != 0) { + printf("%s: timeout waiting for command 0x%02x reply\n", + sc->sc_dev.dv_xname, code); + } + return error; +} + +void +otus_write(struct otus_softc *sc, uint32_t reg, uint32_t val) +{ + sc->write_buf[sc->write_idx].reg = htole32(reg); + sc->write_buf[sc->write_idx].val = htole32(val); + + if (++sc->write_idx > AR_MAX_WRITE_IDX) + (void)otus_write_barrier(sc); +} + +int +otus_write_barrier(struct otus_softc *sc) +{ + int error; + + if (sc->write_idx == 0) + return 0; /* Nothing to flush. */ + + error = otus_cmd(sc, AR_CMD_WREG, sc->write_buf, + sizeof (sc->write_buf[0]) * sc->write_idx, NULL); + sc->write_idx = 0; + return error; +} + +/* ARGSUSED */ +void +otus_intr(usbd_xfer_handle xfer, usbd_private_handle priv, usbd_status status) +{ + /* + * The Rx intr pipe is unused with current firmware. Notifications + * and replies to commands are sent through the Rx bulk pipe instead + * (with a magic PLCP header.) + */ +} + +struct ieee80211_node * +otus_node_alloc(struct ieee80211com *ic) +{ + return malloc(sizeof (struct otus_node), M_DEVBUF, M_NOWAIT | M_ZERO); +} + +int +otus_media_change(struct ifnet *ifp) +{ + struct otus_softc *sc = ifp->if_softc; + struct ieee80211com *ic = &sc->sc_ic; + uint8_t rate, ridx; + int error; + + error = ieee80211_media_change(ifp); + if (error != ENETRESET) + return error; + + if (ic->ic_fixed_rate != -1) { + rate = ic->ic_sup_rates[ic->ic_curmode]. + rs_rates[ic->ic_fixed_rate] & IEEE80211_RATE_VAL; + for (ridx = 0; ridx <= OTUS_RIDX_MAX; ridx++) + if (otus_rates[ridx].rate == rate) + break; + sc->fixed_ridx = ridx; + } + + if ((ifp->if_flags & (IFF_UP | IFF_RUNNING)) == (IFF_UP | IFF_RUNNING)) + error = otus_init(ifp); + + return error; +} + +int +otus_read_eeprom(struct otus_softc *sc) +{ + uint32_t regs[8], reg; + uint8_t *eep; + int i, j, error; + + /* Read EEPROM by blocks of 32 bytes. */ + eep = (uint8_t *)&sc->eeprom; + reg = 0x1600; + for (i = 0; i < sizeof (sc->eeprom) / 32; i++) { + for (j = 0; j < 8; j++, reg += 4) + regs[j] = htole32(reg); + error = otus_cmd(sc, AR_CMD_RREG, regs, sizeof regs, eep); + if (error != 0) + break; + eep += 32; + } + return error; +} + +void +otus_newassoc(struct ieee80211com *ic, struct ieee80211_node *ni, int isnew) +{ + struct otus_softc *sc = ic->ic_softc; + struct otus_node *on = (void *)ni; + struct ieee80211_rateset *rs = &ni->ni_rates; + uint8_t rate; + int ridx, i; + + DPRINTF(("new assoc isnew=%d addr=%s\n", + isnew, ether_sprintf(ni->ni_macaddr))); + + ieee80211_amrr_node_init(&sc->amrr, &on->amn); + /* Start at lowest available bit-rate, AMRR will raise. */ + ni->ni_txrate = 0; + + for (i = 0; i < rs->rs_nrates; i++) { + rate = rs->rs_rates[i] & IEEE80211_RATE_VAL; + /* Convert 802.11 rate to hardware rate index. */ + for (ridx = 0; ridx <= OTUS_RIDX_MAX; ridx++) + if (otus_rates[ridx].rate == rate) + break; + on->ridx[i] = ridx; + DPRINTF(("rate=0x%02x ridx=%d\n", + rs->rs_rates[i], on->ridx[i])); + } +} + +void +otus_cmd_rxeof(struct otus_softc *sc, uint8_t *buf, int len) +{ + struct ieee80211com *ic = &sc->sc_ic; + struct otus_tx_cmd *cmd; + struct ar_cmd_hdr *hdr; + int s; + + if (__predict_false(len < sizeof (*hdr))) { + DPRINTF(("cmd too small %d\n", len)); + return; + } + hdr = (struct ar_cmd_hdr *)buf; + if (__predict_false(sizeof (*hdr) + hdr->len > len || + sizeof (*hdr) + hdr->len > 64)) { + DPRINTF(("cmd too large %d\n", hdr->len)); + return; + } + + if ((hdr->code & 0xc0) != 0xc0) { + DPRINTFN(2, ("received reply code=0x%02x len=%d token=%d\n", + hdr->code, hdr->len, hdr->token)); + cmd = &sc->tx_cmd; + if (__predict_false(hdr->token != cmd->token)) + return; + /* Copy answer into caller's supplied buffer. */ + if (cmd->odata != NULL) + memcpy(cmd->odata, &hdr[1], hdr->len); + cmd->done = 1; + wakeup(cmd); + return; + } + + /* Received unsolicited notification. */ + DPRINTF(("received notification code=0x%02x len=%d\n", + hdr->code, hdr->len)); + switch (hdr->code & 0x3f) { + case AR_EVT_BEACON: + break; + case AR_EVT_TX_COMP: + { + struct ar_evt_tx_comp *tx = (struct ar_evt_tx_comp *)&hdr[1]; + struct ieee80211_node *ni; + struct otus_node *on; + + DPRINTF(("tx completed %s status=%d phy=0x%x\n", + ether_sprintf(tx->macaddr), letoh16(tx->status), + letoh32(tx->phy))); + s = splnet(); +#ifdef notyet +#ifndef IEEE80211_STA_ONLY + if (ic->ic_opmode != IEEE80211_M_STA) { + ni = ieee80211_find_node(ic, tx->macaddr); + if (__predict_false(ni == NULL)) { + splx(s); + break; + } + } else +#endif +#endif + ni = ic->ic_bss; + /* Update rate control statistics. */ + on = (void *)ni; + /* NB: we do not set the TX_MAC_RATE_PROBING flag. */ + if (__predict_true(tx->status != 0)) + on->amn.amn_retrycnt++; + splx(s); + break; + } + case AR_EVT_TBTT: + break; + } +} + +void +otus_sub_rxeof(struct otus_softc *sc, uint8_t *buf, int len) +{ + struct ieee80211com *ic = &sc->sc_ic; + struct ifnet *ifp = &ic->ic_if; + struct ieee80211_rxinfo rxi; + struct ieee80211_node *ni; + struct ar_rx_tail *tail; + struct ieee80211_frame *wh; + struct mbuf *m; + uint8_t *plcp; + int s, mlen, align; + + if (__predict_false(len < AR_PLCP_HDR_LEN)) { + DPRINTF(("sub-xfer too short %d\n", len)); + return; + } + plcp = (uint8_t *)buf; + + /* All bits in the PLCP header are set to 1 for non-MPDU. */ + if (memcmp(plcp, AR_PLCP_HDR_INTR, AR_PLCP_HDR_LEN) == 0) { + otus_cmd_rxeof(sc, plcp + AR_PLCP_HDR_LEN, + len - AR_PLCP_HDR_LEN); + return; + } + + /* Received MPDU. */ + if (__predict_false(len < AR_PLCP_HDR_LEN + sizeof (*tail))) { + DPRINTF(("MPDU too short %d\n", len)); + return; + } + tail = (struct ar_rx_tail *)(plcp + len - sizeof (*tail)); + + /* Discard error frames. */ + if (__predict_false(tail->error != 0)) { + DPRINTF(("error frame 0x%02x\n", tail->error)); + return; + } + /* Compute MPDU's length. */ + mlen = len - AR_PLCP_HDR_LEN - sizeof (*tail); + /* Make sure there's room for an 802.11 header + FCS. */ + if (__predict_false(mlen < IEEE80211_MIN_LEN)) + return; + mlen -= IEEE80211_CRC_LEN; /* strip 802.11 FCS */ + + wh = (struct ieee80211_frame *)(plcp + AR_PLCP_HDR_LEN); + /* Provide a 32-bit aligned protocol header to the stack. */ + align = (ieee80211_has_qos(wh) ^ ieee80211_has_addr4(wh)) ? 2 : 0; + + MGETHDR(m, M_DONTWAIT, MT_DATA); + if (__predict_false(m == NULL)) { + ifp->if_ierrors++; + return; + } + if (align + mlen > MHLEN) { + MCLGET(m, M_DONTWAIT); + if (__predict_false(!(m->m_flags & M_EXT))) { + ifp->if_ierrors++; + m_freem(m); + return; + } + } + /* Finalize mbuf. */ + m->m_pkthdr.rcvif = ifp; + m->m_data += align; + memcpy(mtod(m, caddr_t), wh, mlen); + m->m_pkthdr.len = m->m_len = mlen; + +#if NBPFILTER > 0 + if (__predict_false(sc->sc_drvbpf != NULL)) { + struct otus_rx_radiotap_header *tap = &sc->sc_rxtap; + struct mbuf mb; + + tap->wr_flags = 0; + tap->wr_chan_freq = htole16(ic->ic_ibss_chan->ic_freq); + tap->wr_chan_flags = htole16(ic->ic_ibss_chan->ic_flags); + tap->wr_antsignal = tail->rssi; + tap->wr_rate = 2; /* In case it can't be found below. */ + switch (tail->status & AR_RX_STATUS_MT_MASK) { + case AR_RX_STATUS_MT_CCK: + switch (plcp[0]) { + case 0x0: tap->wr_rate = 2; break; + case 0x1: tap->wr_rate = 4; break; + case 0x2: tap->wr_rate = 11; break; + case 0x3: tap->wr_rate = 22; break; + } + if (tail->status & AR_RX_STATUS_SHPREAMBLE) + tap->wr_flags |= IEEE80211_RADIOTAP_F_SHORTPRE; + break; + case AR_RX_STATUS_MT_OFDM: + switch (plcp[0] & 0xf) { + case 0xb: tap->wr_rate = 12; break; + case 0xf: tap->wr_rate = 18; break; + case 0xa: tap->wr_rate = 24; break; + case 0xe: tap->wr_rate = 36; break; + case 0x9: tap->wr_rate = 48; break; + case 0xd: tap->wr_rate = 72; break; + case 0x8: tap->wr_rate = 96; break; + case 0xc: tap->wr_rate = 108; break; + } + break; + } + mb.m_data = (caddr_t)tap; + mb.m_len = sc->sc_rxtap_len; + mb.m_next = m; + mb.m_nextpkt = NULL; + mb.m_type = 0; + mb.m_flags = 0; + bpf_mtap(sc->sc_drvbpf, &mb, BPF_DIRECTION_IN); + } +#endif + + s = splnet(); + ni = ieee80211_find_rxnode(ic, wh); + rxi.rxi_flags = 0; + rxi.rxi_rssi = tail->rssi; + rxi.rxi_tstamp = 0; /* unused */ + ieee80211_input(ifp, m, ni, &rxi); + + /* Node is no longer needed. */ + ieee80211_release_node(ic, ni); + splx(s); +} + +void +otus_rxeof(usbd_xfer_handle xfer, usbd_private_handle priv, usbd_status status) +{ + struct otus_rx_data *data = priv; + struct otus_softc *sc = data->sc; + caddr_t buf = data->buf; + struct ar_rx_head *head; + uint16_t hlen; + int len; + + if (__predict_false(status != USBD_NORMAL_COMPLETION)) { + DPRINTF(("RX status=%d\n", status)); + if (status == USBD_STALLED) + usbd_clear_endpoint_stall_async(sc->data_rx_pipe); + if (status != USBD_CANCELLED) + goto resubmit; + return; + } + usbd_get_xfer_status(xfer, NULL, NULL, &len, NULL); + + while (len >= sizeof (*head)) { + head = (struct ar_rx_head *)buf; + if (__predict_false(head->tag != htole16(AR_RX_HEAD_TAG))) { + DPRINTF(("tag not valid 0x%x\n", letoh16(head->tag))); + break; + } + hlen = letoh16(head->len); + if (__predict_false(sizeof (*head) + hlen > len)) { + DPRINTF(("xfer too short %d/%d\n", len, hlen)); + break; + } + /* Process sub-xfer. */ + otus_sub_rxeof(sc, (uint8_t *)&head[1], hlen); + + /* Next sub-xfer is aligned on a 32-bit boundary. */ + hlen = (sizeof (*head) + hlen + 3) & ~3; + buf += hlen; + len -= hlen; + } + + resubmit: + usbd_setup_xfer(xfer, sc->data_rx_pipe, data, data->buf, OTUS_RXBUFSZ, + USBD_SHORT_XFER_OK, USBD_NO_TIMEOUT, otus_rxeof); + (void)usbd_transfer(data->xfer); +} + +void +otus_txeof(usbd_xfer_handle xfer, usbd_private_handle priv, usbd_status status) +{ + struct otus_tx_data *data = priv; + struct otus_softc *sc = data->sc; + struct ieee80211com *ic = &sc->sc_ic; + struct ifnet *ifp = &ic->ic_if; + int s; + + if (__predict_false(status != USBD_NORMAL_COMPLETION)) { + DPRINTF(("TX status=%d\n", status)); + if (status == USBD_STALLED) + usbd_clear_endpoint_stall_async(sc->data_tx_pipe); + ifp->if_oerrors++; + return; + } + s = splnet(); + sc->tx_queued--; + sc->sc_tx_timer = 0; + ifp->if_flags &= ~IFF_OACTIVE; + otus_start(ifp); + splx(s); +} + +int +otus_tx(struct otus_softc *sc, struct mbuf *m, struct ieee80211_node *ni) +{ + struct ieee80211com *ic = &sc->sc_ic; + struct otus_node *on = (void *)ni; + struct otus_tx_data *data; + struct ieee80211_frame *wh; + struct ieee80211_key *k; + struct ar_tx_head *head; + uint32_t phyctl; + uint16_t macctl, qos; + int error, ridx, hasqos, xferlen; + + wh = mtod(m, struct ieee80211_frame *); + if (wh->i_fc[1] & IEEE80211_FC1_PROTECTED) { + k = ieee80211_get_txkey(ic, wh, ni); + if ((m = ieee80211_encrypt(ic, m, k)) == NULL) + return ENOBUFS; + wh = mtod(m, struct ieee80211_frame *); + } + + if ((hasqos = ieee80211_has_qos(wh))) + qos = ieee80211_get_qos(wh); + + /* Pickup a rate index. */ + if (IEEE80211_IS_MULTICAST(wh->i_addr1) || + (wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK) != IEEE80211_FC0_TYPE_DATA) + ridx = (ic->ic_curmode == IEEE80211_MODE_11A) ? + OTUS_RIDX_OFDM6 : OTUS_RIDX_CCK1; + else if (ic->ic_fixed_rate != -1) + ridx = sc->fixed_ridx; + else + ridx = on->ridx[ni->ni_txrate]; + + phyctl = 0; + macctl = AR_TX_MAC_BACKOFF | AR_TX_MAC_HW_DUR; +#if 0 + /* XXX this can be used to get Tx notifications of success. */ + macctl |= AR_TX_MAC_RATE_PROBING; +#endif + + if (IEEE80211_IS_MULTICAST(wh->i_addr1) || + (hasqos && ((qos & IEEE80211_QOS_ACK_POLICY_MASK) == + IEEE80211_QOS_ACK_POLICY_NOACK))) + macctl |= AR_TX_MAC_NOACK; + + if (!IEEE80211_IS_MULTICAST(wh->i_addr1) && + m->m_pkthdr.len + IEEE80211_CRC_LEN >= ic->ic_rtsthreshold) + macctl |= AR_TX_MAC_RTS; + else if ((ic->ic_flags & IEEE80211_F_USEPROT) && + ridx >= OTUS_RIDX_OFDM6) { + if (ic->ic_protmode == IEEE80211_PROT_CTSONLY) + macctl |= AR_TX_MAC_CTS; + else if (ic->ic_protmode == IEEE80211_PROT_RTSCTS) + macctl |= AR_TX_MAC_RTS; + } + + phyctl |= AR_TX_PHY_MCS(otus_rates[ridx].mcs); + if (ridx >= OTUS_RIDX_OFDM6) { + phyctl |= AR_TX_PHY_MT_OFDM; + if (ridx <= OTUS_RIDX_OFDM24) + phyctl |= AR_TX_PHY_ANTMSK(5); + else + phyctl |= AR_TX_PHY_ANTMSK(1); + } else { /* CCK */ + phyctl |= AR_TX_PHY_MT_CCK; + phyctl |= AR_TX_PHY_ANTMSK(5); + } + + /* Update rate control stats for frames that need an ACK. */ + if (!(macctl & AR_TX_MAC_NOACK)) + ((struct otus_node *)ni)->amn.amn_txcnt++; + + data = &sc->tx_data[sc->tx_cur]; + /* Fill Tx descriptor. */ + head = (struct ar_tx_head *)data->buf; + head->len = htole16(m->m_pkthdr.len + IEEE80211_CRC_LEN); + head->macctl = htole16(macctl); + head->phyctl = htole32(phyctl); + +#if NBPFILTER > 0 + if (__predict_false(sc->sc_drvbpf != NULL)) { + struct otus_tx_radiotap_header *tap = &sc->sc_txtap; + struct mbuf mb; + + tap->wt_flags = 0; + tap->wt_rate = otus_rates[ridx].rate; + tap->wt_chan_freq = htole16(ic->ic_bss->ni_chan->ic_freq); + tap->wt_chan_flags = htole16(ic->ic_bss->ni_chan->ic_flags); + + mb.m_data = (caddr_t)tap; + mb.m_len = sc->sc_txtap_len; + mb.m_next = m; + mb.m_nextpkt = NULL; + mb.m_type = 0; + mb.m_flags = 0; + bpf_mtap(sc->sc_drvbpf, &mb, BPF_DIRECTION_OUT); + } +#endif + + xferlen = sizeof (*head) + m->m_pkthdr.len; + m_copydata(m, 0, m->m_pkthdr.len, (caddr_t)&head[1]); + m_freem(m); + ieee80211_release_node(ic, ni); + + DPRINTFN(5, ("tx queued=%d len=%d mac=0x%04x phy=0x%08x rate=%d\n", + sc->tx_queued, head->len, head->macctl, head->phyctl, + otus_rates[ridx].rate)); + usbd_setup_xfer(data->xfer, sc->data_tx_pipe, data, data->buf, xferlen, + USBD_FORCE_SHORT_XFER | USBD_NO_COPY, OTUS_TX_TIMEOUT, otus_txeof); + error = usbd_transfer(data->xfer); + if (__predict_false(error != USBD_IN_PROGRESS && error != 0)) + return error; + + sc->tx_queued++; + sc->tx_cur = (sc->tx_cur + 1) % OTUS_TX_DATA_LIST_COUNT; + + return 0; +} + +void +otus_start(struct ifnet *ifp) +{ + struct otus_softc *sc = ifp->if_softc; + struct ieee80211com *ic = &sc->sc_ic; + struct ieee80211_node *ni; + struct mbuf *m; + + if ((ifp->if_flags & (IFF_RUNNING | IFF_OACTIVE)) != IFF_RUNNING) + return; + + for (;;) { + if (sc->tx_queued >= OTUS_TX_DATA_LIST_COUNT) { + ifp->if_flags |= IFF_OACTIVE; + break; + } + /* Send pending management frames first. */ + IF_DEQUEUE(&ic->ic_mgtq, m); + if (m != NULL) { + ni = (void *)m->m_pkthdr.rcvif; + goto sendit; + } + if (ic->ic_state != IEEE80211_S_RUN) + break; + + /* Encapsulate and send data frames. */ + IFQ_DEQUEUE(&ifp->if_snd, m); + if (m == NULL) + break; +#if NBPFILTER > 0 + if (ifp->if_bpf != NULL) + bpf_mtap(ifp->if_bpf, m, BPF_DIRECTION_OUT); +#endif + if ((m = ieee80211_encap(ifp, m, &ni)) == NULL) + continue; +sendit: +#if NBPFILTER > 0 + if (ic->ic_rawbpf != NULL) + bpf_mtap(ic->ic_rawbpf, m, BPF_DIRECTION_OUT); +#endif + if (otus_tx(sc, m, ni) != 0) { + ieee80211_release_node(ic, ni); + ifp->if_oerrors++; + continue; + } + + sc->sc_tx_timer = 5; + ifp->if_timer = 1; + } +} + +void +otus_watchdog(struct ifnet *ifp) +{ + struct otus_softc *sc = ifp->if_softc; + + ifp->if_timer = 0; + + if (sc->sc_tx_timer > 0) { + if (--sc->sc_tx_timer == 0) { + printf("%s: device timeout\n", sc->sc_dev.dv_xname); + /* otus_init(ifp); XXX needs a process context! */ + ifp->if_oerrors++; + return; + } + ifp->if_timer = 1; + } + ieee80211_watchdog(ifp); +} + +int +otus_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data) +{ + struct otus_softc *sc = ifp->if_softc; + struct ieee80211com *ic = &sc->sc_ic; + struct ifaddr *ifa; + struct ifreq *ifr; + int s, error = 0; + + s = splnet(); + + switch (cmd) { + case SIOCSIFADDR: + ifa = (struct ifaddr *)data; + ifp->if_flags |= IFF_UP; +#ifdef INET + if (ifa->ifa_addr->sa_family == AF_INET) + arp_ifinit(&ic->ic_ac, ifa); +#endif + /* FALLTHROUGH */ + case SIOCSIFFLAGS: + if (ifp->if_flags & IFF_UP) { + if ((ifp->if_flags & IFF_RUNNING) && + ((ifp->if_flags ^ sc->sc_if_flags) & + (IFF_ALLMULTI | IFF_PROMISC)) != 0) { + otus_set_multi(sc); + } else if (!(ifp->if_flags & IFF_RUNNING)) + otus_init(ifp); + + } else if (ifp->if_flags & IFF_RUNNING) + otus_stop(ifp); + + sc->sc_if_flags = ifp->if_flags; + break; + case SIOCADDMULTI: + case SIOCDELMULTI: + ifr = (struct ifreq *)data; + error = (cmd == SIOCADDMULTI) ? + ether_addmulti(ifr, &ic->ic_ac) : + ether_delmulti(ifr, &ic->ic_ac); + if (error == ENETRESET) + error = 0; + break; + default: + error = ieee80211_ioctl(ifp, cmd, data); + } + + if (error == ENETRESET) { + if ((ifp->if_flags & (IFF_UP | IFF_RUNNING)) == + (IFF_UP | IFF_RUNNING)) + otus_init(ifp); + error = 0; + } + + splx(s); + return error; +} + +int +otus_set_multi(struct otus_softc *sc) +{ + struct arpcom *ac = &sc->sc_ic.ic_ac; + struct ifnet *ifp = &ac->ac_if; + struct ether_multi *enm; + struct ether_multistep step; + uint32_t lo, hi; + uint8_t bit; + + if ((ifp->if_flags & (IFF_ALLMULTI | IFF_PROMISC)) != 0) { + lo = hi = 0xffffffff; + goto done; + } + lo = hi = 0; + ETHER_FIRST_MULTI(step, ac, enm); + while (enm != NULL) { + if (bcmp(enm->enm_addrlo, enm->enm_addrhi, ETHER_ADDR_LEN)) { + ifp->if_flags |= IFF_ALLMULTI; + lo = hi = 0xffffffff; + goto done; + } + bit = enm->enm_addrlo[5] >> 2; + if (bit < 32) + lo |= 1 << bit; + else + hi |= 1 << (bit - 32); + ETHER_NEXT_MULTI(step, enm); + } + done: + hi |= 1 << 31; /* make sure the broadcast bit is set */ + otus_write(sc, AR_MAC_REG_GROUP_HASH_TBL_L, lo); + otus_write(sc, AR_MAC_REG_GROUP_HASH_TBL_H, hi); + return otus_write_barrier(sc); +} + +void +otus_updateedca(struct ieee80211com *ic) +{ + /* Do it in a process context. */ + otus_do_async(ic->ic_softc, otus_updateedca_cb, NULL, 0); +} + +/* ARGSUSED */ +void +otus_updateedca_cb(struct otus_softc *sc, void *arg) +{ +#define EXP2(val) ((1 << (val)) - 1) +#define AIFS(val) ((val) * 9 + 10) + struct ieee80211com *ic = &sc->sc_ic; + const struct ieee80211_edca_ac_params *edca; + int s; + + s = splnet(); + + edca = (ic->ic_flags & IEEE80211_F_QOS) ? + ic->ic_edca_ac : otus_edca_def; + + /* Set CWmin/CWmax values. */ + otus_write(sc, AR_MAC_REG_AC0_CW, + EXP2(edca[EDCA_AC_BE].ac_ecwmax) << 16 | + EXP2(edca[EDCA_AC_BE].ac_ecwmin)); + otus_write(sc, AR_MAC_REG_AC1_CW, + EXP2(edca[EDCA_AC_BK].ac_ecwmax) << 16 | + EXP2(edca[EDCA_AC_BK].ac_ecwmin)); + otus_write(sc, AR_MAC_REG_AC2_CW, + EXP2(edca[EDCA_AC_VI].ac_ecwmax) << 16 | + EXP2(edca[EDCA_AC_VI].ac_ecwmin)); + otus_write(sc, AR_MAC_REG_AC3_CW, + EXP2(edca[EDCA_AC_VO].ac_ecwmax) << 16 | + EXP2(edca[EDCA_AC_VO].ac_ecwmin)); + otus_write(sc, AR_MAC_REG_AC4_CW, /* Special TXQ. */ + EXP2(edca[EDCA_AC_VO].ac_ecwmax) << 16 | + EXP2(edca[EDCA_AC_VO].ac_ecwmin)); + + /* Set AIFSN values. */ + otus_write(sc, AR_MAC_REG_AC1_AC0_AIFS, + AIFS(edca[EDCA_AC_VI].ac_aifsn) << 24 | + AIFS(edca[EDCA_AC_BK].ac_aifsn) << 12 | + AIFS(edca[EDCA_AC_BE].ac_aifsn)); + otus_write(sc, AR_MAC_REG_AC3_AC2_AIFS, + AIFS(edca[EDCA_AC_VO].ac_aifsn) << 16 | /* Special TXQ. */ + AIFS(edca[EDCA_AC_VO].ac_aifsn) << 4 | + AIFS(edca[EDCA_AC_VI].ac_aifsn) >> 8); + + /* Set TXOP limit. */ + otus_write(sc, AR_MAC_REG_AC1_AC0_TXOP, + edca[EDCA_AC_BK].ac_txoplimit << 16 | + edca[EDCA_AC_BE].ac_txoplimit); + otus_write(sc, AR_MAC_REG_AC3_AC2_TXOP, + edca[EDCA_AC_VO].ac_txoplimit << 16 | + edca[EDCA_AC_VI].ac_txoplimit); + + splx(s); + + (void)otus_write_barrier(sc); +#undef AIFS +#undef EXP2 +} + +void +otus_updateslot(struct ieee80211com *ic) +{ + /* Do it in a process context. */ + otus_do_async(ic->ic_softc, otus_updateslot_cb, NULL, 0); +} + +/* ARGSUSED */ +void +otus_updateslot_cb(struct otus_softc *sc, void *arg) +{ + uint32_t slottime; + + slottime = (sc->sc_ic.ic_flags & IEEE80211_F_SHSLOT) ? 9 : 20; + otus_write(sc, AR_MAC_REG_SLOT_TIME, slottime << 10); + (void)otus_write_barrier(sc); +} + +int +otus_init_mac(struct otus_softc *sc) +{ + int error; + + otus_write(sc, AR_MAC_REG_ACK_EXTENSION, 0x40); + otus_write(sc, AR_MAC_REG_RETRY_MAX, 0); + otus_write(sc, AR_MAC_REG_SNIFFER, 0x2000000); + otus_write(sc, AR_MAC_REG_RX_THRESHOLD, 0xc1f80); + otus_write(sc, AR_MAC_REG_RX_PE_DELAY, 0x70); + otus_write(sc, AR_MAC_REG_EIFS_AND_SIFS, 0xa144000); + otus_write(sc, AR_MAC_REG_SLOT_TIME, 9 << 10); + otus_write(sc, 0x1c3b2c, 0x19000000); + /* NAV protects ACK only (in TXOP). */ + otus_write(sc, 0x1c3b38, 0x201); + /* Set beacon Tx power to 0x7. */ + otus_write(sc, AR_MAC_REG_BCN_HT1, 0x8000170); + otus_write(sc, AR_MAC_REG_BACKOFF_PROTECT, 0x105); + otus_write(sc, 0x1c3b9c, 0x10000a); + /* Filter any control frames, BAR is bit 24. */ + otus_write(sc, 0x1c368c, 0x0500ffff); + otus_write(sc, 0x1c3c40, 0x1); + otus_write(sc, AR_MAC_REG_BASIC_RATE, 0x150f); + otus_write(sc, AR_MAC_REG_MANDATORY_RATE, 0x150f); + otus_write(sc, AR_MAC_REG_RTS_CTS_RATE, 0x10b01bb); + otus_write(sc, 0x1c3694, 0x4003c1e); + /* Enable LED0 and LED1. */ + otus_write(sc, 0x1d0100, 0x3); + otus_write(sc, 0x1d0104, 0x3); + /* Switch MAC to OTUS interface. */ + otus_write(sc, 0x1c3600, 0x3); + otus_write(sc, 0x1c3c50, 0xffff); + otus_write(sc, 0x1c3680, 0xf00008); + /* Disable Rx timeout (workaround). */ + otus_write(sc, 0x1c362c, 0); + + /* Set USB Rx stream mode maximum frame number to 2. */ + otus_write(sc, 0x1e1110, 0x4); + /* Set USB Rx stream mode timeout to 10us. */ + otus_write(sc, 0x1e1114, 0x80); + + /* Set clock frequency to 88/80MHz. */ + otus_write(sc, 0x1d4008, 0x73); + /* Set WLAN DMA interrupt mode: generate intr per packet. */ + otus_write(sc, 0x1c3d7c, 0x110011); + otus_write(sc, 0x1c3bb0, 0x4); + otus_write(sc, AR_MAC_REG_TXOP_NOT_ENOUGH_INDICATION, 0x141e0f48); + + /* Disable HW decryption for now. */ + otus_write(sc, 0x1c3678, 0x78); + + if ((error = otus_write_barrier(sc)) != 0) + return error; + + /* Set default EDCA parameters. */ + otus_updateedca_cb(sc, NULL); + + return 0; +} + +static __inline void +otus_phy_write(struct otus_softc *sc, uint32_t reg, uint32_t val) +{ + otus_write(sc, 0x1bc000 + reg, val); +} + +/* + * Return default value for PHY register based on current operating mode. + */ +uint32_t +otus_phy_get_def(struct otus_softc *sc, uint32_t reg) +{ + int i; + + for (i = 0; i < nitems(ar5416_phy_regs); i++) + if (AR_PHY(ar5416_phy_regs[i]) == reg) + return sc->phy_vals[i]; + return 0; /* register not found */ +} + +/* + * Update PHY's programming based on vendor-specific data stored in EEPROM. + * This is for FEM-type devices only. + */ +int +otus_set_board_values(struct otus_softc *sc, struct ieee80211_channel *c) +{ + const struct ModalEepHeader *eep; + uint32_t tmp, offset; + + if (IEEE80211_IS_CHAN_5GHZ(c)) + eep = &sc->eeprom.modalHeader[0]; + else + eep = &sc->eeprom.modalHeader[1]; + + /* Offset of chain 2. */ + offset = 2 * 0x1000; + + tmp = letoh32(eep->antCtrlCommon); + otus_phy_write(sc, AR_PHY_SWITCH_COM, tmp); + + tmp = letoh32(eep->antCtrlChain[0]); + otus_phy_write(sc, AR_PHY_SWITCH_CHAIN_0, tmp); + + tmp = letoh32(eep->antCtrlChain[1]); + otus_phy_write(sc, AR_PHY_SWITCH_CHAIN_0 + offset, tmp); + + if (1 /* sc->sc_sco == AR_SCO_SCN */) { + tmp = otus_phy_get_def(sc, AR_PHY_SETTLING); + tmp &= ~(0x7f << 7); + tmp |= (eep->switchSettling & 0x7f) << 7; + otus_phy_write(sc, AR_PHY_SETTLING, tmp); + } + + tmp = otus_phy_get_def(sc, AR_PHY_DESIRED_SZ); + tmp &= ~0xffff; + tmp |= eep->pgaDesiredSize << 8 | eep->adcDesiredSize; + otus_phy_write(sc, AR_PHY_DESIRED_SZ, tmp); + + tmp = eep->txEndToXpaOff << 24 | eep->txEndToXpaOff << 16 | + eep->txFrameToXpaOn << 8 | eep->txFrameToXpaOn; + otus_phy_write(sc, AR_PHY_RF_CTL4, tmp); + + tmp = otus_phy_get_def(sc, AR_PHY_RF_CTL3); + tmp &= ~(0xff << 16); + tmp |= eep->txEndToRxOn << 16; + otus_phy_write(sc, AR_PHY_RF_CTL3, tmp); + + tmp = otus_phy_get_def(sc, AR_PHY_CCA); + tmp &= ~(0x7f << 12); + tmp |= (eep->thresh62 & 0x7f) << 12; + otus_phy_write(sc, AR_PHY_CCA, tmp); + + tmp = otus_phy_get_def(sc, AR_PHY_RXGAIN); + tmp &= ~(0x3f << 12); + tmp |= (eep->txRxAttenCh[0] & 0x3f) << 12; + otus_phy_write(sc, AR_PHY_RXGAIN, tmp); + + tmp = otus_phy_get_def(sc, AR_PHY_RXGAIN + offset); + tmp &= ~(0x3f << 12); + tmp |= (eep->txRxAttenCh[1] & 0x3f) << 12; + otus_phy_write(sc, AR_PHY_RXGAIN + offset, tmp); + + tmp = otus_phy_get_def(sc, AR_PHY_GAIN_2GHZ); + tmp &= ~(0x3f << 18); + tmp |= (eep->rxTxMarginCh[0] & 0x3f) << 18; + if (IEEE80211_IS_CHAN_5GHZ(c)) { + tmp &= ~(0xf << 10); + tmp |= (eep->bswMargin[0] & 0xf) << 10; + } + otus_phy_write(sc, AR_PHY_GAIN_2GHZ, tmp); + + tmp = otus_phy_get_def(sc, AR_PHY_GAIN_2GHZ + offset); + tmp &= ~(0x3f << 18); + tmp |= (eep->rxTxMarginCh[1] & 0x3f) << 18; + otus_phy_write(sc, AR_PHY_GAIN_2GHZ + offset, tmp); + + tmp = otus_phy_get_def(sc, AR_PHY_TIMING_CTRL4); + tmp &= ~(0x3f << 5 | 0x1f); + tmp |= (eep->iqCalICh[0] & 0x3f) << 5 | (eep->iqCalQCh[0] & 0x1f); + otus_phy_write(sc, AR_PHY_TIMING_CTRL4, tmp); + + tmp = otus_phy_get_def(sc, AR_PHY_TIMING_CTRL4 + offset); + tmp &= ~(0x3f << 5 | 0x1f); + tmp |= (eep->iqCalICh[1] & 0x3f) << 5 | (eep->iqCalQCh[1] & 0x1f); + otus_phy_write(sc, AR_PHY_TIMING_CTRL4 + offset, tmp); + + tmp = otus_phy_get_def(sc, 0xa258); + tmp &= ~(0xf << 16); + tmp |= (eep->xpd & 0xf) << 16; + otus_phy_write(sc, 0xa258, tmp); + + return otus_write_barrier(sc); +} + +int +otus_program_phy(struct otus_softc *sc, struct ieee80211_channel *c) +{ + const uint32_t *vals; + int error, i; + + /* Select PHY programming based on band and bandwidth. */ + if (IEEE80211_IS_CHAN_2GHZ(c)) + vals = ar5416_phy_vals_2ghz_20mhz; + else + vals = ar5416_phy_vals_5ghz_20mhz; + for (i = 0; i < nitems(ar5416_phy_regs); i++) + otus_phy_write(sc, AR_PHY(ar5416_phy_regs[i]), vals[i]); + sc->phy_vals = vals; + + if (sc->eeprom.baseEepHeader.deviceType == 0x80) /* FEM */ + if ((error = otus_set_board_values(sc, c)) != 0) + return error; + + /* Initial Tx power settings. */ + otus_phy_write(sc, AR_PHY( 79), 0x7f); + otus_phy_write(sc, AR_PHY( 77), 0x3f3f3f3f); + otus_phy_write(sc, AR_PHY( 78), 0x3f3f3f3f); + otus_phy_write(sc, AR_PHY(653), 0x3f3f3f3f); + otus_phy_write(sc, AR_PHY(654), 0x3f3f3f3f); + otus_phy_write(sc, AR_PHY(739), 0x3f3f3f3f); + otus_phy_write(sc, AR_PHY(740), 0x3f3f3f3f); + otus_phy_write(sc, AR_PHY(755), 0x3f3f3f3f); + otus_phy_write(sc, AR_PHY(756), 0x3f3f3f3f); + otus_phy_write(sc, AR_PHY(757), 0x3f3f3f3f); + + if (IEEE80211_IS_CHAN_2GHZ(c)) + otus_write(sc, 0x1d4014, 0x5163); + else + otus_write(sc, 0x1d4014, 0x5143); + + return otus_write_barrier(sc); +} + +static __inline uint8_t +otus_reverse_bits(uint8_t v) +{ + v = ((v >> 1) & 0x55) | ((v & 0x55) << 1); + v = ((v >> 2) & 0x33) | ((v & 0x33) << 2); + v = ((v >> 4) & 0x0f) | ((v & 0x0f) << 4); + return v; +} + +void +otus_get_delta_slope(uint32_t coeff, uint32_t *exponent, uint32_t *mantissa) +{ +#define COEFF_SCALE_SHIFT 24 + uint32_t exp, man; + + /* exponent = 14 - floor(log2(coeff)) */ + for (exp = 31; exp > 0; exp--) + if (coeff & (1 << exp)) + break; + KASSERT(exp != 0); + exp = 14 - (exp - COEFF_SCALE_SHIFT); + + /* mantissa = floor(coeff * 2^exponent + 0.5) */ + man = coeff + (1 << (COEFF_SCALE_SHIFT - exp - 1)); + + *mantissa = man >> (COEFF_SCALE_SHIFT - exp); + *exponent = exp - 16; +#undef COEFF_SCALE_SHIFT +} + +int +otus_set_chan(struct otus_softc *sc, struct ieee80211_channel *c) +{ + struct ieee80211com *ic = &sc->sc_ic; + struct ar_cmd_frequency cmd; + struct ar_rsp_frequency rsp; + const uint32_t *vals; + uint32_t coeff, exp, man, tmp; + uint16_t data; + uint8_t code, chansel, d0, d1; + int error, chan, i; + + chan = ieee80211_chan2ieee(ic, c); + DPRINTF(("setting channel %d\n", chan)); + + tmp = IEEE80211_IS_CHAN_2GHZ(c) ? 0x105 : 0x104; + otus_write(sc, AR_MAC_REG_DYNAMIC_SIFS_ACK, tmp); + (void)otus_write_barrier(sc); + + /* clear bb_heavy_clip_enable */ + otus_phy_write(sc, 0x99e0, 0x200); + (void)otus_write_barrier(sc); + + error = otus_cmd(sc, AR_CMD_FREQ_STRAT, NULL, 0, NULL); + if (error != 0) + return error; + + /* Reprogram PHY and RF on band or channel bandwidth changes. */ + if (1 || c->ic_flags != sc->sc_curchan->ic_flags) { + DPRINTF(("band switch\n")); + + /* Reset BB/ADDA. */ + otus_write(sc, 0x1d4004, 0x400); /* XXX cold/warm */ + (void)otus_write_barrier(sc); + otus_write(sc, 0x1d4004, 0); + (void)otus_write_barrier(sc); + + if ((error = otus_program_phy(sc, c)) != 0) { + printf("%s: could not program PHY\n", + sc->sc_dev.dv_xname); + return error; + } + + /* Select RF programming based on band. */ + if (IEEE80211_IS_CHAN_5GHZ(c)) + vals = ar5416_banks_vals_5ghz; + else + vals = ar5416_banks_vals_2ghz; + for (i = 0; i < nitems(ar5416_banks_regs); i++) { + otus_phy_write(sc, AR_PHY(ar5416_banks_regs[i]), + vals[i]); + } + if ((error = otus_write_barrier(sc)) != 0) + return error; + + code = AR_CMD_RF_INIT; + } else { + code = AR_CMD_FREQUENCY; + } + + d0 = 0; + if (IEEE80211_IS_CHAN_5GHZ(c)) { + chansel = (c->ic_freq - 4800) / 5; + if (chansel & 1) + d0 |= AR_BANK4_AMODE_REFSEL(2); + else + d0 |= AR_BANK4_AMODE_REFSEL(1); + } else { + d0 |= AR_BANK4_AMODE_REFSEL(2); + if (chan == 14) { + d0 |= AR_BANK4_BMODE_LF_SYNTH_FREQ; + chansel = 10 + (c->ic_freq - 2274) / 5; + } else + chansel = 16 + (c->ic_freq - 2272) / 5; + chansel <<= 2; + } + d0 |= AR_BANK4_ADDR(1) | AR_BANK4_CHUP; + d1 = otus_reverse_bits(chansel); + + /* write bits 0-4 of d0 and d1 */ + data = (d1 & 0x1f) << 5 | (d0 & 0x1f); + otus_phy_write(sc, AR_PHY(44), data); + /* write bits 5-7 of d0 and d1 */ + data = (d1 >> 5) << 5 | (d0 >> 5); + otus_phy_write(sc, AR_PHY(58), data); + + if ((error = otus_write_barrier(sc)) != 0) + return error; + usbd_delay_ms(sc->sc_udev, 10); + + otus_phy_write(sc, AR_PHY(1), 0x100 | 0x240); /* XXX UB83 */ + (void)otus_write_barrier(sc); + + /* Send firmware command to set channel. */ + cmd.freq = htole32((uint32_t)c->ic_freq * 1000); + cmd.dynht2040 = htole32(0); + cmd.htena = htole32(1); + /* Set Delta Slope (exponent and mantissa). */ + coeff = (100 << 24) / c->ic_freq; + otus_get_delta_slope(coeff, &exp, &man); + cmd.delta_slope_coeff_exp = htole32(exp); + cmd.delta_slope_coeff_man = htole32(man); + /* For Short GI, coeff is 9/10 of normal coeff. */ + coeff = (9 * coeff) / 10; + otus_get_delta_slope(coeff, &exp, &man); + cmd.delta_slope_coeff_exp_shgi = htole32(exp); + cmd.delta_slope_coeff_man_shgi = htole32(man); + /* Set wait time for AGC and noise calibration (100ms). */ + cmd.check_loop_count = htole32(1000); + DPRINTF(("%s: exp=%d man=%d exp_shgi=%d man_shgi=%d\n", + (code == AR_CMD_RF_INIT) ? "RF_INIT" : "FREQUENCY", + letoh32(cmd.delta_slope_coeff_exp), + letoh32(cmd.delta_slope_coeff_man), + letoh32(cmd.delta_slope_coeff_exp_shgi), + letoh32(cmd.delta_slope_coeff_man_shgi))); + error = otus_cmd(sc, code, &cmd, sizeof (cmd), &rsp); + if (error != 0) + return error; + + DPRINTF(("status=0x%x\n", letoh32(rsp.status))); + sc->sc_curchan = c; + + return 0; +} + +#ifdef notyet +int +otus_set_key(struct ieee80211com *ic, struct ieee80211_node *ni, + struct ieee80211_key *k) +{ + struct otus_softc *sc = ic->ic_softc; + struct otus_cmd_key cmd; + + /* Do it in a process context. */ + cmd.key = *k; + cmd.associd = (ni != NULL) ? ni->ni_associd : 0; + otus_do_async(sc, otus_set_key_cb, &cmd, sizeof cmd); + return 0; +} + +void +otus_set_key_cb(struct otus_softc *sc, void *arg) +{ + struct otus_cmd_key *cmd = arg; + struct ieee80211_key *k = &cmd->key; + struct ar_cmd_ekey key; + uint16_t cipher; + int error; + + memset(&key, 0, sizeof key); + if (k->k_flags & IEEE80211_KEY_GROUP) { + key.uid = htole16(k->k_id); + IEEE80211_ADDR_COPY(key.macaddr, sc->sc_ic.ic_myaddr); + } else { + key.uid = htole16(OTUS_UID(cmd->associd)); + IEEE80211_ADDR_COPY(key.macaddr, ni->ni_macaddr); + } + key.kid = htole16(0); + /* Map net80211 cipher to hardware. */ + switch (k->k_cipher) { + case IEEE80211_CIPHER_WEP40: + cipher = AR_CIPHER_WEP64; + break; + case IEEE80211_CIPHER_WEP104: + cipher = AR_CIPHER_WEP128; + break; + case IEEE80211_CIPHER_TKIP: + cipher = AR_CIPHER_TKIP; + break; + case IEEE80211_CIPHER_CCMP: + cipher = AR_CIPHER_AES; + break; + default: + return; + } + key.cipher = htole16(cipher); + memcpy(key.key, k->k_key, MIN(k->k_len, 16)); + error = otus_cmd(sc, AR_CMD_EKEY, &key, sizeof key, NULL); + if (error != 0 || k->k_cipher != IEEE80211_CIPHER_TKIP) + return; + + /* TKIP: set Tx/Rx MIC Key. */ + key.kid = htole16(1); + memcpy(key.key, k->k_key + 16, 16); + (void)otus_cmd(sc, AR_CMD_EKEY, &key, sizeof key, NULL); +} + +void +otus_delete_key(struct ieee80211com *ic, struct ieee80211_node *ni, + struct ieee80211_key *k) +{ + struct otus_softc *sc = ic->ic_softc; + struct otus_cmd_key cmd; + + if (!(ic->ic_if.if_flags & IFF_RUNNING) || + ic->ic_state != IEEE80211_S_RUN) + return; /* Nothing to do. */ + + /* Do it in a process context. */ + cmd.key = *k; + cmd.associd = (ni != NULL) ? ni->ni_associd : 0; + otus_do_async(sc, otus_delete_key_cb, &cmd, sizeof cmd); +} + +void +otus_delete_key_cb(struct otus_softc *sc, void *arg) +{ + struct otus_cmd_key *cmd = arg; + struct ieee80211_key *k = &cmd->key; + uint32_t uid; + + if (k->k_flags & IEEE80211_KEY_GROUP) + uid = htole32(k->k_id); + else + uid = htole32(OTUS_UID(cmd->associd)); + (void)otus_cmd(sc, AR_CMD_DKEY, &uid, sizeof uid, NULL); +} +#endif + +void +otus_calibrate_to(void *arg) +{ + struct otus_softc *sc = arg; + struct ieee80211com *ic = &sc->sc_ic; + struct ieee80211_node *ni; + int s; + + s = splnet(); + ni = ic->ic_bss; + ieee80211_amrr_choose(&sc->amrr, ni, &((struct otus_node *)ni)->amn); + splx(s); + + timeout_add_sec(&sc->calib_to, 1); +} + +int +otus_set_bssid(struct otus_softc *sc, const uint8_t *bssid) +{ + otus_write(sc, 0x1c3618, + bssid[0] | bssid[1] << 8 | bssid[2] << 16 | bssid[3] << 24); + otus_write(sc, 0x1c361c, + bssid[4] | bssid[5] << 8); + return otus_write_barrier(sc); +} + +int +otus_set_macaddr(struct otus_softc *sc, const uint8_t *addr) +{ + otus_write(sc, AR_MAC_REG_MAC_ADDR_L, + addr[0] | addr[1] << 8 | addr[2] << 16 | addr[3] << 24); + otus_write(sc, AR_MAC_REG_MAC_ADDR_H, + addr[4] | addr[5] << 8); + return otus_write_barrier(sc); +} + +/* Default single-LED. */ +void +otus_led_newstate_type1(struct otus_softc *sc) +{ + /* TBD */ +} + +/* NETGEAR, dual-LED. */ +void +otus_led_newstate_type2(struct otus_softc *sc) +{ + /* TBD */ +} + +/* NETGEAR, single-LED/3 colors (blue, red, purple.) */ +void +otus_led_newstate_type3(struct otus_softc *sc) +{ + struct ieee80211com *ic = &sc->sc_ic; + uint32_t state = sc->led_state; + + if (ic->ic_state == IEEE80211_S_INIT) { + state = 0; /* LED off. */ + } else if (ic->ic_state == IEEE80211_S_RUN) { + /* Associated, LED always on. */ + if (IEEE80211_IS_CHAN_2GHZ(sc->sc_curchan)) + state = AR_LED0_ON; /* 2GHz=>Red. */ + else + state = AR_LED1_ON; /* 5GHz=>Blue. */ + } else { + /* Scanning, blink LED. */ + state ^= AR_LED0_ON | AR_LED1_ON; + if (IEEE80211_IS_CHAN_2GHZ(sc->sc_curchan)) + state &= ~AR_LED1_ON; + else + state &= ~AR_LED0_ON; + } + if (state != sc->led_state) { + otus_write(sc, 0x1d0104, state); + if (otus_write_barrier(sc) == 0) + sc->led_state = state; + } +} + +int +otus_init(struct ifnet *ifp) +{ + struct otus_softc *sc = ifp->if_softc; + struct ieee80211com *ic = &sc->sc_ic; + int error; + + /* Init host command ring. */ + sc->cmdq.cur = sc->cmdq.next = sc->cmdq.queued = 0; + + if ((error = otus_init_mac(sc)) != 0) { + printf("%s: could not initialize MAC\n", sc->sc_dev.dv_xname); + return error; + } + + IEEE80211_ADDR_COPY(ic->ic_myaddr, LLADDR(ifp->if_sadl)); + (void)otus_set_macaddr(sc, ic->ic_myaddr); + + switch (ic->ic_opmode) { +#ifdef notyet +#ifndef IEEE80211_STA_ONLY + case IEEE80211_M_HOSTAP: + otus_write(sc, 0x1c3700, 0x0f0000a1); + otus_write(sc, 0x1c3c40, 0x1); + break; + case IEEE80211_M_IBSS: + otus_write(sc, 0x1c3700, 0x0f000000); + otus_write(sc, 0x1c3c40, 0x1); + break; +#endif +#endif + case IEEE80211_M_STA: + otus_write(sc, 0x1c3700, 0x0f000002); + otus_write(sc, 0x1c3c40, 0x1); + break; + default: + break; + } + otus_write(sc, AR_MAC_REG_SNIFFER, + (ic->ic_opmode == IEEE80211_M_MONITOR) ? 0x2000001 : 0x2000000); + (void)otus_write_barrier(sc); + + ic->ic_bss->ni_chan = ic->ic_ibss_chan; + sc->sc_curchan = &ic->ic_channels[0]; /* Force band switch. */ + if ((error = otus_set_chan(sc, ic->ic_ibss_chan)) != 0) { + printf("%s: could not set channel\n", sc->sc_dev.dv_xname); + return error; + } + + /* Start Rx. */ + otus_write(sc, 0x1c3d30, 0x100); + otus_write_barrier(sc); + + ifp->if_flags &= ~IFF_OACTIVE; + ifp->if_flags |= IFF_RUNNING; + + if (ic->ic_opmode == IEEE80211_M_MONITOR) + ieee80211_new_state(ic, IEEE80211_S_RUN, -1); + else + ieee80211_new_state(ic, IEEE80211_S_SCAN, -1); + + return 0; +} + +void +otus_stop(struct ifnet *ifp) +{ + struct otus_softc *sc = ifp->if_softc; + struct ieee80211com *ic = &sc->sc_ic; + int s; + + sc->sc_tx_timer = 0; + ifp->if_timer = 0; + ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE); + + timeout_del(&sc->scan_to); + timeout_del(&sc->calib_to); + + s = splusb(); + ieee80211_new_state(ic, IEEE80211_S_INIT, -1); + /* Wait for all queued asynchronous commands to complete. */ + while (sc->cmdq.queued > 0) + tsleep(&sc->cmdq, 0, "cmdq", 0); + splx(s); + + /* Stop Rx. */ + otus_write(sc, 0x1c3d30, 0); + (void)otus_write_barrier(sc); + + sc->tx_queued = 0; +} |