3 4/* 5 * Copyright (c) 2007 Marcus Glocker <mglocker@openbsd.org> 6 * 7 * Permission to use, copy, modify, and distribute this software for any 8 * purpose with or without fee is hereby granted, provided that the above 9 * copyright notice and this permission notice appear in all copies. 10 * 11 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 12 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 13 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 14 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 15 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 16 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 17 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 18 */ 19 20#include <sys/param.h> 21#include <sys/systm.h> 22#include <sys/kernel.h> 23#include <sys/endian.h> 24#include <sys/firmware.h> 25#include <sys/linker.h> 26#include <sys/mbuf.h> 27#include <sys/malloc.h> 28#include <sys/module.h> 29#include <sys/socket.h> 30#include <sys/sockio.h> 31#include <sys/sysctl.h> 32 33#include <net/if.h> 34#include <net/if_arp.h> 35#include <net/ethernet.h> 36#include <net/if_dl.h> 37#include <net/if_media.h> 38#include <net/if_types.h> 39 40#include <sys/bus.h> 41#include <machine/bus.h> 42 43#include <net80211/ieee80211_var.h> 44#include <net80211/ieee80211_phy.h> 45#include <net80211/ieee80211_radiotap.h> 46#include <net80211/ieee80211_regdomain.h> 47 48#include <net/bpf.h> 49 50#include <dev/usb/usb.h> 51#include <dev/usb/usbdi.h> 52#include "usbdevs.h" 53 54#include <dev/usb/wlan/if_upgtvar.h> 55 56/* 57 * Driver for the USB PrismGT devices. 58 * 59 * For now just USB 2.0 devices with the GW3887 chipset are supported. 60 * The driver has been written based on the firmware version 2.13.1.0_LM87. 61 * 62 * TODO's: 63 * - MONITOR mode test. 64 * - Add HOSTAP mode. 65 * - Add IBSS mode. 66 * - Support the USB 1.0 devices (NET2280, ISL3880, ISL3886 chipsets). 67 * 68 * Parts of this driver has been influenced by reading the p54u driver 69 * written by Jean-Baptiste Note <jean-baptiste.note@m4x.org> and 70 * Sebastien Bourdeauducq <lekernel@prism54.org>. 71 */ 72 73static SYSCTL_NODE(_hw, OID_AUTO, upgt, CTLFLAG_RD, 0, 74 "USB PrismGT GW3887 driver parameters"); 75 76#ifdef UPGT_DEBUG 77int upgt_debug = 0; 78SYSCTL_INT(_hw_upgt, OID_AUTO, debug, CTLFLAG_RW | CTLFLAG_TUN, &upgt_debug, 79 0, "control debugging printfs"); 80TUNABLE_INT("hw.upgt.debug", &upgt_debug); 81enum { 82 UPGT_DEBUG_XMIT = 0x00000001, /* basic xmit operation */ 83 UPGT_DEBUG_RECV = 0x00000002, /* basic recv operation */ 84 UPGT_DEBUG_RESET = 0x00000004, /* reset processing */ 85 UPGT_DEBUG_INTR = 0x00000008, /* INTR */ 86 UPGT_DEBUG_TX_PROC = 0x00000010, /* tx ISR proc */ 87 UPGT_DEBUG_RX_PROC = 0x00000020, /* rx ISR proc */ 88 UPGT_DEBUG_STATE = 0x00000040, /* 802.11 state transitions */ 89 UPGT_DEBUG_STAT = 0x00000080, /* statistic */ 90 UPGT_DEBUG_FW = 0x00000100, /* firmware */ 91 UPGT_DEBUG_ANY = 0xffffffff 92}; 93#define DPRINTF(sc, m, fmt, ...) do { \ 94 if (sc->sc_debug & (m)) \ 95 printf(fmt, __VA_ARGS__); \ 96} while (0) 97#else 98#define DPRINTF(sc, m, fmt, ...) do { \ 99 (void) sc; \ 100} while (0) 101#endif 102 103/* 104 * Prototypes. 105 */ 106static device_probe_t upgt_match; 107static device_attach_t upgt_attach; 108static device_detach_t upgt_detach; 109static int upgt_alloc_tx(struct upgt_softc *); 110static int upgt_alloc_rx(struct upgt_softc *); 111static int upgt_device_reset(struct upgt_softc *); 112static void upgt_bulk_tx(struct upgt_softc *, struct upgt_data *); 113static int upgt_fw_verify(struct upgt_softc *); 114static int upgt_mem_init(struct upgt_softc *); 115static int upgt_fw_load(struct upgt_softc *); 116static int upgt_fw_copy(const uint8_t *, char *, int); 117static uint32_t upgt_crc32_le(const void *, size_t); 118static struct mbuf * 119 upgt_rxeof(struct usb_xfer *, struct upgt_data *, int *); 120static struct mbuf * 121 upgt_rx(struct upgt_softc *, uint8_t *, int, int *); 122static void upgt_txeof(struct usb_xfer *, struct upgt_data *); 123static int upgt_eeprom_read(struct upgt_softc *); 124static int upgt_eeprom_parse(struct upgt_softc *); 125static void upgt_eeprom_parse_hwrx(struct upgt_softc *, uint8_t *); 126static void upgt_eeprom_parse_freq3(struct upgt_softc *, uint8_t *, int); 127static void upgt_eeprom_parse_freq4(struct upgt_softc *, uint8_t *, int); 128static void upgt_eeprom_parse_freq6(struct upgt_softc *, uint8_t *, int); 129static uint32_t upgt_chksum_le(const uint32_t *, size_t); 130static void upgt_tx_done(struct upgt_softc *, uint8_t *); 131static void upgt_init(void *); 132static void upgt_init_locked(struct upgt_softc *); 133static int upgt_ioctl(struct ifnet *, u_long, caddr_t); 134static void upgt_start(struct ifnet *); 135static int upgt_raw_xmit(struct ieee80211_node *, struct mbuf *, 136 const struct ieee80211_bpf_params *); 137static void upgt_scan_start(struct ieee80211com *); 138static void upgt_scan_end(struct ieee80211com *); 139static void upgt_set_channel(struct ieee80211com *); 140static struct ieee80211vap *upgt_vap_create(struct ieee80211com *, 141 const char [IFNAMSIZ], int, enum ieee80211_opmode, int, 142 const uint8_t [IEEE80211_ADDR_LEN], 143 const uint8_t [IEEE80211_ADDR_LEN]); 144static void upgt_vap_delete(struct ieee80211vap *); 145static void upgt_update_mcast(struct ifnet *); 146static uint8_t upgt_rx_rate(struct upgt_softc *, const int); 147static void upgt_set_multi(void *); 148static void upgt_stop(struct upgt_softc *); 149static void upgt_setup_rates(struct ieee80211vap *, struct ieee80211com *); 150static int upgt_set_macfilter(struct upgt_softc *, uint8_t); 151static int upgt_newstate(struct ieee80211vap *, enum ieee80211_state, int); 152static void upgt_set_chan(struct upgt_softc *, struct ieee80211_channel *); 153static void upgt_set_led(struct upgt_softc *, int); 154static void upgt_set_led_blink(void *); 155static void upgt_get_stats(struct upgt_softc *); 156static void upgt_mem_free(struct upgt_softc *, uint32_t); 157static uint32_t upgt_mem_alloc(struct upgt_softc *); 158static void upgt_free_tx(struct upgt_softc *); 159static void upgt_free_rx(struct upgt_softc *); 160static void upgt_watchdog(void *); 161static void upgt_abort_xfers(struct upgt_softc *); 162static void upgt_abort_xfers_locked(struct upgt_softc *); 163static void upgt_sysctl_node(struct upgt_softc *); 164static struct upgt_data * 165 upgt_getbuf(struct upgt_softc *); 166static struct upgt_data * 167 upgt_gettxbuf(struct upgt_softc *); 168static int upgt_tx_start(struct upgt_softc *, struct mbuf *, 169 struct ieee80211_node *, struct upgt_data *); 170 171static const char *upgt_fwname = "upgt-gw3887"; 172 173static const STRUCT_USB_HOST_ID upgt_devs[] = { 174#define UPGT_DEV(v,p) { USB_VP(USB_VENDOR_##v, USB_PRODUCT_##v##_##p) } 175 /* version 2 devices */ 176 UPGT_DEV(ACCTON, PRISM_GT), 177 UPGT_DEV(BELKIN, F5D7050), 178 UPGT_DEV(CISCOLINKSYS, WUSB54AG), 179 UPGT_DEV(CONCEPTRONIC, PRISM_GT), 180 UPGT_DEV(DELL, PRISM_GT_1), 181 UPGT_DEV(DELL, PRISM_GT_2), 182 UPGT_DEV(FSC, E5400), 183 UPGT_DEV(GLOBESPAN, PRISM_GT_1), 184 UPGT_DEV(GLOBESPAN, PRISM_GT_2), 185 UPGT_DEV(NETGEAR, WG111V2_2), 186 UPGT_DEV(INTERSIL, PRISM_GT), 187 UPGT_DEV(SMC, 2862WG), 188 UPGT_DEV(USR, USR5422), 189 UPGT_DEV(WISTRONNEWEB, UR045G), 190 UPGT_DEV(XYRATEX, PRISM_GT_1), 191 UPGT_DEV(XYRATEX, PRISM_GT_2), 192 UPGT_DEV(ZCOM, XG703A), 193 UPGT_DEV(ZCOM, XM142) 194}; 195 196static usb_callback_t upgt_bulk_rx_callback; 197static usb_callback_t upgt_bulk_tx_callback; 198 199static const struct usb_config upgt_config[UPGT_N_XFERS] = { 200 [UPGT_BULK_TX] = { 201 .type = UE_BULK, 202 .endpoint = UE_ADDR_ANY, 203 .direction = UE_DIR_OUT,
| 3 4/* 5 * Copyright (c) 2007 Marcus Glocker <mglocker@openbsd.org> 6 * 7 * Permission to use, copy, modify, and distribute this software for any 8 * purpose with or without fee is hereby granted, provided that the above 9 * copyright notice and this permission notice appear in all copies. 10 * 11 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 12 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 13 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 14 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 15 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 16 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 17 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 18 */ 19 20#include <sys/param.h> 21#include <sys/systm.h> 22#include <sys/kernel.h> 23#include <sys/endian.h> 24#include <sys/firmware.h> 25#include <sys/linker.h> 26#include <sys/mbuf.h> 27#include <sys/malloc.h> 28#include <sys/module.h> 29#include <sys/socket.h> 30#include <sys/sockio.h> 31#include <sys/sysctl.h> 32 33#include <net/if.h> 34#include <net/if_arp.h> 35#include <net/ethernet.h> 36#include <net/if_dl.h> 37#include <net/if_media.h> 38#include <net/if_types.h> 39 40#include <sys/bus.h> 41#include <machine/bus.h> 42 43#include <net80211/ieee80211_var.h> 44#include <net80211/ieee80211_phy.h> 45#include <net80211/ieee80211_radiotap.h> 46#include <net80211/ieee80211_regdomain.h> 47 48#include <net/bpf.h> 49 50#include <dev/usb/usb.h> 51#include <dev/usb/usbdi.h> 52#include "usbdevs.h" 53 54#include <dev/usb/wlan/if_upgtvar.h> 55 56/* 57 * Driver for the USB PrismGT devices. 58 * 59 * For now just USB 2.0 devices with the GW3887 chipset are supported. 60 * The driver has been written based on the firmware version 2.13.1.0_LM87. 61 * 62 * TODO's: 63 * - MONITOR mode test. 64 * - Add HOSTAP mode. 65 * - Add IBSS mode. 66 * - Support the USB 1.0 devices (NET2280, ISL3880, ISL3886 chipsets). 67 * 68 * Parts of this driver has been influenced by reading the p54u driver 69 * written by Jean-Baptiste Note <jean-baptiste.note@m4x.org> and 70 * Sebastien Bourdeauducq <lekernel@prism54.org>. 71 */ 72 73static SYSCTL_NODE(_hw, OID_AUTO, upgt, CTLFLAG_RD, 0, 74 "USB PrismGT GW3887 driver parameters"); 75 76#ifdef UPGT_DEBUG 77int upgt_debug = 0; 78SYSCTL_INT(_hw_upgt, OID_AUTO, debug, CTLFLAG_RW | CTLFLAG_TUN, &upgt_debug, 79 0, "control debugging printfs"); 80TUNABLE_INT("hw.upgt.debug", &upgt_debug); 81enum { 82 UPGT_DEBUG_XMIT = 0x00000001, /* basic xmit operation */ 83 UPGT_DEBUG_RECV = 0x00000002, /* basic recv operation */ 84 UPGT_DEBUG_RESET = 0x00000004, /* reset processing */ 85 UPGT_DEBUG_INTR = 0x00000008, /* INTR */ 86 UPGT_DEBUG_TX_PROC = 0x00000010, /* tx ISR proc */ 87 UPGT_DEBUG_RX_PROC = 0x00000020, /* rx ISR proc */ 88 UPGT_DEBUG_STATE = 0x00000040, /* 802.11 state transitions */ 89 UPGT_DEBUG_STAT = 0x00000080, /* statistic */ 90 UPGT_DEBUG_FW = 0x00000100, /* firmware */ 91 UPGT_DEBUG_ANY = 0xffffffff 92}; 93#define DPRINTF(sc, m, fmt, ...) do { \ 94 if (sc->sc_debug & (m)) \ 95 printf(fmt, __VA_ARGS__); \ 96} while (0) 97#else 98#define DPRINTF(sc, m, fmt, ...) do { \ 99 (void) sc; \ 100} while (0) 101#endif 102 103/* 104 * Prototypes. 105 */ 106static device_probe_t upgt_match; 107static device_attach_t upgt_attach; 108static device_detach_t upgt_detach; 109static int upgt_alloc_tx(struct upgt_softc *); 110static int upgt_alloc_rx(struct upgt_softc *); 111static int upgt_device_reset(struct upgt_softc *); 112static void upgt_bulk_tx(struct upgt_softc *, struct upgt_data *); 113static int upgt_fw_verify(struct upgt_softc *); 114static int upgt_mem_init(struct upgt_softc *); 115static int upgt_fw_load(struct upgt_softc *); 116static int upgt_fw_copy(const uint8_t *, char *, int); 117static uint32_t upgt_crc32_le(const void *, size_t); 118static struct mbuf * 119 upgt_rxeof(struct usb_xfer *, struct upgt_data *, int *); 120static struct mbuf * 121 upgt_rx(struct upgt_softc *, uint8_t *, int, int *); 122static void upgt_txeof(struct usb_xfer *, struct upgt_data *); 123static int upgt_eeprom_read(struct upgt_softc *); 124static int upgt_eeprom_parse(struct upgt_softc *); 125static void upgt_eeprom_parse_hwrx(struct upgt_softc *, uint8_t *); 126static void upgt_eeprom_parse_freq3(struct upgt_softc *, uint8_t *, int); 127static void upgt_eeprom_parse_freq4(struct upgt_softc *, uint8_t *, int); 128static void upgt_eeprom_parse_freq6(struct upgt_softc *, uint8_t *, int); 129static uint32_t upgt_chksum_le(const uint32_t *, size_t); 130static void upgt_tx_done(struct upgt_softc *, uint8_t *); 131static void upgt_init(void *); 132static void upgt_init_locked(struct upgt_softc *); 133static int upgt_ioctl(struct ifnet *, u_long, caddr_t); 134static void upgt_start(struct ifnet *); 135static int upgt_raw_xmit(struct ieee80211_node *, struct mbuf *, 136 const struct ieee80211_bpf_params *); 137static void upgt_scan_start(struct ieee80211com *); 138static void upgt_scan_end(struct ieee80211com *); 139static void upgt_set_channel(struct ieee80211com *); 140static struct ieee80211vap *upgt_vap_create(struct ieee80211com *, 141 const char [IFNAMSIZ], int, enum ieee80211_opmode, int, 142 const uint8_t [IEEE80211_ADDR_LEN], 143 const uint8_t [IEEE80211_ADDR_LEN]); 144static void upgt_vap_delete(struct ieee80211vap *); 145static void upgt_update_mcast(struct ifnet *); 146static uint8_t upgt_rx_rate(struct upgt_softc *, const int); 147static void upgt_set_multi(void *); 148static void upgt_stop(struct upgt_softc *); 149static void upgt_setup_rates(struct ieee80211vap *, struct ieee80211com *); 150static int upgt_set_macfilter(struct upgt_softc *, uint8_t); 151static int upgt_newstate(struct ieee80211vap *, enum ieee80211_state, int); 152static void upgt_set_chan(struct upgt_softc *, struct ieee80211_channel *); 153static void upgt_set_led(struct upgt_softc *, int); 154static void upgt_set_led_blink(void *); 155static void upgt_get_stats(struct upgt_softc *); 156static void upgt_mem_free(struct upgt_softc *, uint32_t); 157static uint32_t upgt_mem_alloc(struct upgt_softc *); 158static void upgt_free_tx(struct upgt_softc *); 159static void upgt_free_rx(struct upgt_softc *); 160static void upgt_watchdog(void *); 161static void upgt_abort_xfers(struct upgt_softc *); 162static void upgt_abort_xfers_locked(struct upgt_softc *); 163static void upgt_sysctl_node(struct upgt_softc *); 164static struct upgt_data * 165 upgt_getbuf(struct upgt_softc *); 166static struct upgt_data * 167 upgt_gettxbuf(struct upgt_softc *); 168static int upgt_tx_start(struct upgt_softc *, struct mbuf *, 169 struct ieee80211_node *, struct upgt_data *); 170 171static const char *upgt_fwname = "upgt-gw3887"; 172 173static const STRUCT_USB_HOST_ID upgt_devs[] = { 174#define UPGT_DEV(v,p) { USB_VP(USB_VENDOR_##v, USB_PRODUCT_##v##_##p) } 175 /* version 2 devices */ 176 UPGT_DEV(ACCTON, PRISM_GT), 177 UPGT_DEV(BELKIN, F5D7050), 178 UPGT_DEV(CISCOLINKSYS, WUSB54AG), 179 UPGT_DEV(CONCEPTRONIC, PRISM_GT), 180 UPGT_DEV(DELL, PRISM_GT_1), 181 UPGT_DEV(DELL, PRISM_GT_2), 182 UPGT_DEV(FSC, E5400), 183 UPGT_DEV(GLOBESPAN, PRISM_GT_1), 184 UPGT_DEV(GLOBESPAN, PRISM_GT_2), 185 UPGT_DEV(NETGEAR, WG111V2_2), 186 UPGT_DEV(INTERSIL, PRISM_GT), 187 UPGT_DEV(SMC, 2862WG), 188 UPGT_DEV(USR, USR5422), 189 UPGT_DEV(WISTRONNEWEB, UR045G), 190 UPGT_DEV(XYRATEX, PRISM_GT_1), 191 UPGT_DEV(XYRATEX, PRISM_GT_2), 192 UPGT_DEV(ZCOM, XG703A), 193 UPGT_DEV(ZCOM, XM142) 194}; 195 196static usb_callback_t upgt_bulk_rx_callback; 197static usb_callback_t upgt_bulk_tx_callback; 198 199static const struct usb_config upgt_config[UPGT_N_XFERS] = { 200 [UPGT_BULK_TX] = { 201 .type = UE_BULK, 202 .endpoint = UE_ADDR_ANY, 203 .direction = UE_DIR_OUT,
|
280 ifp = sc->sc_ifp = if_alloc(IFT_IEEE80211); 281 if (ifp == NULL) { 282 device_printf(dev, "can not if_alloc()\n"); 283 goto fail4; 284 } 285 286 /* Initialize the device. */ 287 error = upgt_device_reset(sc); 288 if (error) 289 goto fail5; 290 /* Verify the firmware. */ 291 error = upgt_fw_verify(sc); 292 if (error) 293 goto fail5; 294 /* Calculate device memory space. */ 295 if (sc->sc_memaddr_frame_start == 0 || sc->sc_memaddr_frame_end == 0) { 296 device_printf(dev, 297 "could not find memory space addresses on FW\n"); 298 error = EIO; 299 goto fail5; 300 } 301 sc->sc_memaddr_frame_end -= UPGT_MEMSIZE_RX + 1; 302 sc->sc_memaddr_rx_start = sc->sc_memaddr_frame_end + 1; 303 304 DPRINTF(sc, UPGT_DEBUG_FW, "memory address frame start=0x%08x\n", 305 sc->sc_memaddr_frame_start); 306 DPRINTF(sc, UPGT_DEBUG_FW, "memory address frame end=0x%08x\n", 307 sc->sc_memaddr_frame_end); 308 DPRINTF(sc, UPGT_DEBUG_FW, "memory address rx start=0x%08x\n", 309 sc->sc_memaddr_rx_start); 310 311 upgt_mem_init(sc); 312 313 /* Load the firmware. */ 314 error = upgt_fw_load(sc); 315 if (error) 316 goto fail5; 317 318 /* Read the whole EEPROM content and parse it. */ 319 error = upgt_eeprom_read(sc); 320 if (error) 321 goto fail5; 322 error = upgt_eeprom_parse(sc); 323 if (error) 324 goto fail5; 325 326 /* all works related with the device have done here. */ 327 upgt_abort_xfers(sc); 328 329 /* Setup the 802.11 device. */ 330 ifp->if_softc = sc; 331 if_initname(ifp, "upgt", device_get_unit(sc->sc_dev)); 332 ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST; 333 ifp->if_init = upgt_init; 334 ifp->if_ioctl = upgt_ioctl; 335 ifp->if_start = upgt_start; 336 IFQ_SET_MAXLEN(&ifp->if_snd, ifqmaxlen); 337 IFQ_SET_READY(&ifp->if_snd); 338 339 ic = ifp->if_l2com; 340 ic->ic_ifp = ifp; 341 ic->ic_phytype = IEEE80211_T_OFDM; /* not only, but not used */ 342 ic->ic_opmode = IEEE80211_M_STA; 343 /* set device capabilities */ 344 ic->ic_caps = 345 IEEE80211_C_STA /* station mode */ 346 | IEEE80211_C_MONITOR /* monitor mode */ 347 | IEEE80211_C_SHPREAMBLE /* short preamble supported */ 348 | IEEE80211_C_SHSLOT /* short slot time supported */ 349 | IEEE80211_C_BGSCAN /* capable of bg scanning */ 350 | IEEE80211_C_WPA /* 802.11i */ 351 ; 352 353 bands = 0; 354 setbit(&bands, IEEE80211_MODE_11B); 355 setbit(&bands, IEEE80211_MODE_11G); 356 ieee80211_init_channels(ic, NULL, &bands); 357 358 ieee80211_ifattach(ic, sc->sc_myaddr); 359 ic->ic_raw_xmit = upgt_raw_xmit; 360 ic->ic_scan_start = upgt_scan_start; 361 ic->ic_scan_end = upgt_scan_end; 362 ic->ic_set_channel = upgt_set_channel; 363 364 ic->ic_vap_create = upgt_vap_create; 365 ic->ic_vap_delete = upgt_vap_delete; 366 ic->ic_update_mcast = upgt_update_mcast; 367 368 ieee80211_radiotap_attach(ic, 369 &sc->sc_txtap.wt_ihdr, sizeof(sc->sc_txtap), 370 UPGT_TX_RADIOTAP_PRESENT, 371 &sc->sc_rxtap.wr_ihdr, sizeof(sc->sc_rxtap), 372 UPGT_RX_RADIOTAP_PRESENT); 373 374 upgt_sysctl_node(sc); 375 376 if (bootverbose) 377 ieee80211_announce(ic); 378 379 return (0); 380 381fail5: if_free(ifp); 382fail4: usbd_transfer_unsetup(sc->sc_xfer, UPGT_N_XFERS); 383fail3: upgt_free_rx(sc); 384fail2: upgt_free_tx(sc); 385fail1: mtx_destroy(&sc->sc_mtx); 386 387 return (error); 388} 389 390static void 391upgt_txeof(struct usb_xfer *xfer, struct upgt_data *data) 392{ 393 struct upgt_softc *sc = usbd_xfer_softc(xfer); 394 struct ifnet *ifp = sc->sc_ifp; 395 struct mbuf *m; 396 397 UPGT_ASSERT_LOCKED(sc); 398 399 /* 400 * Do any tx complete callback. Note this must be done before releasing 401 * the node reference. 402 */ 403 if (data->m) { 404 m = data->m; 405 if (m->m_flags & M_TXCB) { 406 /* XXX status? */ 407 ieee80211_process_callback(data->ni, m, 0); 408 } 409 m_freem(m); 410 data->m = NULL; 411 } 412 if (data->ni) { 413 ieee80211_free_node(data->ni); 414 data->ni = NULL; 415 } 416 ifp->if_opackets++; 417} 418 419static void 420upgt_get_stats(struct upgt_softc *sc) 421{ 422 struct upgt_data *data_cmd; 423 struct upgt_lmac_mem *mem; 424 struct upgt_lmac_stats *stats; 425 426 data_cmd = upgt_getbuf(sc); 427 if (data_cmd == NULL) { 428 device_printf(sc->sc_dev, "%s: out of buffer.\n", __func__); 429 return; 430 } 431 432 /* 433 * Transmit the URB containing the CMD data. 434 */ 435 memset(data_cmd->buf, 0, MCLBYTES); 436 437 mem = (struct upgt_lmac_mem *)data_cmd->buf; 438 mem->addr = htole32(sc->sc_memaddr_frame_start + 439 UPGT_MEMSIZE_FRAME_HEAD); 440 441 stats = (struct upgt_lmac_stats *)(mem + 1); 442 443 stats->header1.flags = 0; 444 stats->header1.type = UPGT_H1_TYPE_CTRL; 445 stats->header1.len = htole16( 446 sizeof(struct upgt_lmac_stats) - sizeof(struct upgt_lmac_header)); 447 448 stats->header2.reqid = htole32(sc->sc_memaddr_frame_start); 449 stats->header2.type = htole16(UPGT_H2_TYPE_STATS); 450 stats->header2.flags = 0; 451 452 data_cmd->buflen = sizeof(*mem) + sizeof(*stats); 453 454 mem->chksum = upgt_chksum_le((uint32_t *)stats, 455 data_cmd->buflen - sizeof(*mem)); 456 457 upgt_bulk_tx(sc, data_cmd); 458} 459 460static int 461upgt_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data) 462{ 463 struct upgt_softc *sc = ifp->if_softc; 464 struct ieee80211com *ic = ifp->if_l2com; 465 struct ifreq *ifr = (struct ifreq *) data; 466 int error = 0, startall = 0; 467 468 switch (cmd) { 469 case SIOCSIFFLAGS: 470 if (ifp->if_flags & IFF_UP) { 471 if (ifp->if_drv_flags & IFF_DRV_RUNNING) { 472 if ((ifp->if_flags ^ sc->sc_if_flags) & 473 (IFF_ALLMULTI | IFF_PROMISC)) 474 upgt_set_multi(sc); 475 } else { 476 upgt_init(sc); 477 startall = 1; 478 } 479 } else { 480 if (ifp->if_drv_flags & IFF_DRV_RUNNING) 481 upgt_stop(sc); 482 } 483 sc->sc_if_flags = ifp->if_flags; 484 if (startall) 485 ieee80211_start_all(ic); 486 break; 487 case SIOCGIFMEDIA: 488 error = ifmedia_ioctl(ifp, ifr, &ic->ic_media, cmd); 489 break; 490 case SIOCGIFADDR: 491 error = ether_ioctl(ifp, cmd, data); 492 break; 493 default: 494 error = EINVAL; 495 break; 496 } 497 return error; 498} 499 500static void 501upgt_stop_locked(struct upgt_softc *sc) 502{ 503 struct ifnet *ifp = sc->sc_ifp; 504 505 UPGT_ASSERT_LOCKED(sc); 506 507 if (ifp->if_drv_flags & IFF_DRV_RUNNING) 508 upgt_set_macfilter(sc, IEEE80211_S_INIT); 509 upgt_abort_xfers_locked(sc); 510} 511 512static void 513upgt_stop(struct upgt_softc *sc) 514{ 515 struct ifnet *ifp = sc->sc_ifp; 516 517 UPGT_LOCK(sc); 518 upgt_stop_locked(sc); 519 UPGT_UNLOCK(sc); 520 521 /* device down */ 522 sc->sc_tx_timer = 0; 523 ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE); 524 sc->sc_flags &= ~UPGT_FLAG_INITDONE; 525} 526 527static void 528upgt_set_led(struct upgt_softc *sc, int action) 529{ 530 struct upgt_data *data_cmd; 531 struct upgt_lmac_mem *mem; 532 struct upgt_lmac_led *led; 533 534 data_cmd = upgt_getbuf(sc); 535 if (data_cmd == NULL) { 536 device_printf(sc->sc_dev, "%s: out of buffers.\n", __func__); 537 return; 538 } 539 540 /* 541 * Transmit the URB containing the CMD data. 542 */ 543 memset(data_cmd->buf, 0, MCLBYTES); 544 545 mem = (struct upgt_lmac_mem *)data_cmd->buf; 546 mem->addr = htole32(sc->sc_memaddr_frame_start + 547 UPGT_MEMSIZE_FRAME_HEAD); 548 549 led = (struct upgt_lmac_led *)(mem + 1); 550 551 led->header1.flags = UPGT_H1_FLAGS_TX_NO_CALLBACK; 552 led->header1.type = UPGT_H1_TYPE_CTRL; 553 led->header1.len = htole16( 554 sizeof(struct upgt_lmac_led) - 555 sizeof(struct upgt_lmac_header)); 556 557 led->header2.reqid = htole32(sc->sc_memaddr_frame_start); 558 led->header2.type = htole16(UPGT_H2_TYPE_LED); 559 led->header2.flags = 0; 560 561 switch (action) { 562 case UPGT_LED_OFF: 563 led->mode = htole16(UPGT_LED_MODE_SET); 564 led->action_fix = 0; 565 led->action_tmp = htole16(UPGT_LED_ACTION_OFF); 566 led->action_tmp_dur = 0; 567 break; 568 case UPGT_LED_ON: 569 led->mode = htole16(UPGT_LED_MODE_SET); 570 led->action_fix = 0; 571 led->action_tmp = htole16(UPGT_LED_ACTION_ON); 572 led->action_tmp_dur = 0; 573 break; 574 case UPGT_LED_BLINK: 575 if (sc->sc_state != IEEE80211_S_RUN) { 576 STAILQ_INSERT_TAIL(&sc->sc_tx_inactive, data_cmd, next); 577 return; 578 } 579 if (sc->sc_led_blink) { 580 /* previous blink was not finished */ 581 STAILQ_INSERT_TAIL(&sc->sc_tx_inactive, data_cmd, next); 582 return; 583 } 584 led->mode = htole16(UPGT_LED_MODE_SET); 585 led->action_fix = htole16(UPGT_LED_ACTION_OFF); 586 led->action_tmp = htole16(UPGT_LED_ACTION_ON); 587 led->action_tmp_dur = htole16(UPGT_LED_ACTION_TMP_DUR); 588 /* lock blink */ 589 sc->sc_led_blink = 1; 590 callout_reset(&sc->sc_led_ch, hz, upgt_set_led_blink, sc); 591 break; 592 default: 593 STAILQ_INSERT_TAIL(&sc->sc_tx_inactive, data_cmd, next); 594 return; 595 } 596 597 data_cmd->buflen = sizeof(*mem) + sizeof(*led); 598 599 mem->chksum = upgt_chksum_le((uint32_t *)led, 600 data_cmd->buflen - sizeof(*mem)); 601 602 upgt_bulk_tx(sc, data_cmd); 603} 604 605static void 606upgt_set_led_blink(void *arg) 607{ 608 struct upgt_softc *sc = arg; 609 610 /* blink finished, we are ready for a next one */ 611 sc->sc_led_blink = 0; 612} 613 614static void 615upgt_init(void *priv) 616{ 617 struct upgt_softc *sc = priv; 618 struct ifnet *ifp = sc->sc_ifp; 619 struct ieee80211com *ic = ifp->if_l2com; 620 621 UPGT_LOCK(sc); 622 upgt_init_locked(sc); 623 UPGT_UNLOCK(sc); 624 625 if (ifp->if_drv_flags & IFF_DRV_RUNNING) 626 ieee80211_start_all(ic); /* start all vap's */ 627} 628 629static void 630upgt_init_locked(struct upgt_softc *sc) 631{ 632 struct ifnet *ifp = sc->sc_ifp; 633 634 UPGT_ASSERT_LOCKED(sc); 635 636 if (ifp->if_drv_flags & IFF_DRV_RUNNING) 637 upgt_stop_locked(sc); 638 639 usbd_transfer_start(sc->sc_xfer[UPGT_BULK_RX]); 640 641 (void)upgt_set_macfilter(sc, IEEE80211_S_SCAN); 642 643 ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 644 ifp->if_drv_flags |= IFF_DRV_RUNNING; 645 sc->sc_flags |= UPGT_FLAG_INITDONE; 646 647 callout_reset(&sc->sc_watchdog_ch, hz, upgt_watchdog, sc); 648} 649 650static int 651upgt_set_macfilter(struct upgt_softc *sc, uint8_t state) 652{ 653 struct ifnet *ifp = sc->sc_ifp; 654 struct ieee80211com *ic = ifp->if_l2com; 655 struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 656 struct ieee80211_node *ni; 657 struct upgt_data *data_cmd; 658 struct upgt_lmac_mem *mem; 659 struct upgt_lmac_filter *filter; 660 uint8_t broadcast[] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; 661 662 UPGT_ASSERT_LOCKED(sc); 663 664 data_cmd = upgt_getbuf(sc); 665 if (data_cmd == NULL) { 666 device_printf(sc->sc_dev, "out of TX buffers.\n"); 667 return (ENOBUFS); 668 } 669 670 /* 671 * Transmit the URB containing the CMD data. 672 */ 673 memset(data_cmd->buf, 0, MCLBYTES); 674 675 mem = (struct upgt_lmac_mem *)data_cmd->buf; 676 mem->addr = htole32(sc->sc_memaddr_frame_start + 677 UPGT_MEMSIZE_FRAME_HEAD); 678 679 filter = (struct upgt_lmac_filter *)(mem + 1); 680 681 filter->header1.flags = UPGT_H1_FLAGS_TX_NO_CALLBACK; 682 filter->header1.type = UPGT_H1_TYPE_CTRL; 683 filter->header1.len = htole16( 684 sizeof(struct upgt_lmac_filter) - 685 sizeof(struct upgt_lmac_header)); 686 687 filter->header2.reqid = htole32(sc->sc_memaddr_frame_start); 688 filter->header2.type = htole16(UPGT_H2_TYPE_MACFILTER); 689 filter->header2.flags = 0; 690 691 switch (state) { 692 case IEEE80211_S_INIT: 693 DPRINTF(sc, UPGT_DEBUG_STATE, "%s: set MAC filter to INIT\n", 694 __func__); 695 filter->type = htole16(UPGT_FILTER_TYPE_RESET); 696 break; 697 case IEEE80211_S_SCAN: 698 DPRINTF(sc, UPGT_DEBUG_STATE, 699 "set MAC filter to SCAN (bssid %s)\n", 700 ether_sprintf(broadcast)); 701 filter->type = htole16(UPGT_FILTER_TYPE_NONE); 702 IEEE80211_ADDR_COPY(filter->dst, sc->sc_myaddr); 703 IEEE80211_ADDR_COPY(filter->src, broadcast); 704 filter->unknown1 = htole16(UPGT_FILTER_UNKNOWN1); 705 filter->rxaddr = htole32(sc->sc_memaddr_rx_start); 706 filter->unknown2 = htole16(UPGT_FILTER_UNKNOWN2); 707 filter->rxhw = htole32(sc->sc_eeprom_hwrx); 708 filter->unknown3 = htole16(UPGT_FILTER_UNKNOWN3); 709 break; 710 case IEEE80211_S_RUN: 711 ni = ieee80211_ref_node(vap->iv_bss); 712 /* XXX monitor mode isn't tested yet. */ 713 if (vap->iv_opmode == IEEE80211_M_MONITOR) { 714 filter->type = htole16(UPGT_FILTER_TYPE_MONITOR); 715 IEEE80211_ADDR_COPY(filter->dst, sc->sc_myaddr); 716 IEEE80211_ADDR_COPY(filter->src, ni->ni_bssid); 717 filter->unknown1 = htole16(UPGT_FILTER_MONITOR_UNKNOWN1); 718 filter->rxaddr = htole32(sc->sc_memaddr_rx_start); 719 filter->unknown2 = htole16(UPGT_FILTER_MONITOR_UNKNOWN2); 720 filter->rxhw = htole32(sc->sc_eeprom_hwrx); 721 filter->unknown3 = htole16(UPGT_FILTER_MONITOR_UNKNOWN3); 722 } else { 723 DPRINTF(sc, UPGT_DEBUG_STATE, 724 "set MAC filter to RUN (bssid %s)\n", 725 ether_sprintf(ni->ni_bssid)); 726 filter->type = htole16(UPGT_FILTER_TYPE_STA); 727 IEEE80211_ADDR_COPY(filter->dst, sc->sc_myaddr); 728 IEEE80211_ADDR_COPY(filter->src, ni->ni_bssid); 729 filter->unknown1 = htole16(UPGT_FILTER_UNKNOWN1); 730 filter->rxaddr = htole32(sc->sc_memaddr_rx_start); 731 filter->unknown2 = htole16(UPGT_FILTER_UNKNOWN2); 732 filter->rxhw = htole32(sc->sc_eeprom_hwrx); 733 filter->unknown3 = htole16(UPGT_FILTER_UNKNOWN3); 734 } 735 ieee80211_free_node(ni); 736 break; 737 default: 738 device_printf(sc->sc_dev, 739 "MAC filter does not know that state\n"); 740 break; 741 } 742 743 data_cmd->buflen = sizeof(*mem) + sizeof(*filter); 744 745 mem->chksum = upgt_chksum_le((uint32_t *)filter, 746 data_cmd->buflen - sizeof(*mem)); 747 748 upgt_bulk_tx(sc, data_cmd); 749 750 return (0); 751} 752 753static void 754upgt_setup_rates(struct ieee80211vap *vap, struct ieee80211com *ic) 755{ 756 struct ifnet *ifp = ic->ic_ifp; 757 struct upgt_softc *sc = ifp->if_softc; 758 const struct ieee80211_txparam *tp; 759 760 /* 761 * 0x01 = OFMD6 0x10 = DS1 762 * 0x04 = OFDM9 0x11 = DS2 763 * 0x06 = OFDM12 0x12 = DS5 764 * 0x07 = OFDM18 0x13 = DS11 765 * 0x08 = OFDM24 766 * 0x09 = OFDM36 767 * 0x0a = OFDM48 768 * 0x0b = OFDM54 769 */ 770 const uint8_t rateset_auto_11b[] = 771 { 0x13, 0x13, 0x12, 0x11, 0x11, 0x10, 0x10, 0x10 }; 772 const uint8_t rateset_auto_11g[] = 773 { 0x0b, 0x0a, 0x09, 0x08, 0x07, 0x06, 0x04, 0x01 }; 774 const uint8_t rateset_fix_11bg[] = 775 { 0x10, 0x11, 0x12, 0x13, 0x01, 0x04, 0x06, 0x07, 776 0x08, 0x09, 0x0a, 0x0b }; 777 778 tp = &vap->iv_txparms[ieee80211_chan2mode(ic->ic_curchan)]; 779 780 /* XXX */ 781 if (tp->ucastrate == IEEE80211_FIXED_RATE_NONE) { 782 /* 783 * Automatic rate control is done by the device. 784 * We just pass the rateset from which the device 785 * will pickup a rate. 786 */ 787 if (ic->ic_curmode == IEEE80211_MODE_11B) 788 memcpy(sc->sc_cur_rateset, rateset_auto_11b, 789 sizeof(sc->sc_cur_rateset)); 790 if (ic->ic_curmode == IEEE80211_MODE_11G || 791 ic->ic_curmode == IEEE80211_MODE_AUTO) 792 memcpy(sc->sc_cur_rateset, rateset_auto_11g, 793 sizeof(sc->sc_cur_rateset)); 794 } else { 795 /* set a fixed rate */ 796 memset(sc->sc_cur_rateset, rateset_fix_11bg[tp->ucastrate], 797 sizeof(sc->sc_cur_rateset)); 798 } 799} 800 801static void 802upgt_set_multi(void *arg) 803{ 804 struct upgt_softc *sc = arg; 805 struct ifnet *ifp = sc->sc_ifp; 806 807 if (!(ifp->if_flags & IFF_UP)) 808 return; 809 810 /* 811 * XXX don't know how to set a device. Lack of docs. Just try to set 812 * IFF_ALLMULTI flag here. 813 */ 814 ifp->if_flags |= IFF_ALLMULTI; 815} 816 817static void 818upgt_start(struct ifnet *ifp) 819{ 820 struct upgt_softc *sc = ifp->if_softc; 821 struct upgt_data *data_tx; 822 struct ieee80211_node *ni; 823 struct mbuf *m; 824 825 if ((ifp->if_drv_flags & IFF_DRV_RUNNING) == 0) 826 return; 827 828 UPGT_LOCK(sc); 829 for (;;) { 830 IFQ_DRV_DEQUEUE(&ifp->if_snd, m); 831 if (m == NULL) 832 break; 833 834 data_tx = upgt_gettxbuf(sc); 835 if (data_tx == NULL) { 836 IFQ_DRV_PREPEND(&ifp->if_snd, m); 837 break; 838 } 839 840 ni = (struct ieee80211_node *)m->m_pkthdr.rcvif; 841 m->m_pkthdr.rcvif = NULL; 842 843 if (upgt_tx_start(sc, m, ni, data_tx) != 0) { 844 STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, data_tx, next); 845 UPGT_STAT_INC(sc, st_tx_inactive); 846 ieee80211_free_node(ni); 847 ifp->if_oerrors++; 848 continue; 849 } 850 sc->sc_tx_timer = 5; 851 } 852 UPGT_UNLOCK(sc); 853} 854 855static int 856upgt_raw_xmit(struct ieee80211_node *ni, struct mbuf *m, 857 const struct ieee80211_bpf_params *params) 858{ 859 struct ieee80211com *ic = ni->ni_ic; 860 struct ifnet *ifp = ic->ic_ifp; 861 struct upgt_softc *sc = ifp->if_softc; 862 struct upgt_data *data_tx = NULL; 863 864 /* prevent management frames from being sent if we're not ready */ 865 if (!(ifp->if_drv_flags & IFF_DRV_RUNNING)) { 866 m_freem(m); 867 ieee80211_free_node(ni); 868 return ENETDOWN; 869 } 870 871 UPGT_LOCK(sc); 872 data_tx = upgt_gettxbuf(sc); 873 if (data_tx == NULL) { 874 ieee80211_free_node(ni); 875 m_freem(m); 876 UPGT_UNLOCK(sc); 877 return (ENOBUFS); 878 } 879 880 if (upgt_tx_start(sc, m, ni, data_tx) != 0) { 881 STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, data_tx, next); 882 UPGT_STAT_INC(sc, st_tx_inactive); 883 ieee80211_free_node(ni); 884 ifp->if_oerrors++; 885 UPGT_UNLOCK(sc); 886 return (EIO); 887 } 888 UPGT_UNLOCK(sc); 889 890 sc->sc_tx_timer = 5; 891 return (0); 892} 893 894static void 895upgt_watchdog(void *arg) 896{ 897 struct upgt_softc *sc = arg; 898 struct ifnet *ifp = sc->sc_ifp; 899 900 if (sc->sc_tx_timer > 0) { 901 if (--sc->sc_tx_timer == 0) { 902 device_printf(sc->sc_dev, "watchdog timeout\n"); 903 /* upgt_init(ifp); XXX needs a process context ? */ 904 ifp->if_oerrors++; 905 return; 906 } 907 callout_reset(&sc->sc_watchdog_ch, hz, upgt_watchdog, sc); 908 } 909} 910 911static uint32_t 912upgt_mem_alloc(struct upgt_softc *sc) 913{ 914 int i; 915 916 for (i = 0; i < sc->sc_memory.pages; i++) { 917 if (sc->sc_memory.page[i].used == 0) { 918 sc->sc_memory.page[i].used = 1; 919 return (sc->sc_memory.page[i].addr); 920 } 921 } 922 923 return (0); 924} 925 926static void 927upgt_scan_start(struct ieee80211com *ic) 928{ 929 /* do nothing. */ 930} 931 932static void 933upgt_scan_end(struct ieee80211com *ic) 934{ 935 /* do nothing. */ 936} 937 938static void 939upgt_set_channel(struct ieee80211com *ic) 940{ 941 struct upgt_softc *sc = ic->ic_ifp->if_softc; 942 943 UPGT_LOCK(sc); 944 upgt_set_chan(sc, ic->ic_curchan); 945 UPGT_UNLOCK(sc); 946} 947 948static void 949upgt_set_chan(struct upgt_softc *sc, struct ieee80211_channel *c) 950{ 951 struct ifnet *ifp = sc->sc_ifp; 952 struct ieee80211com *ic = ifp->if_l2com; 953 struct upgt_data *data_cmd; 954 struct upgt_lmac_mem *mem; 955 struct upgt_lmac_channel *chan; 956 int channel; 957 958 UPGT_ASSERT_LOCKED(sc); 959 960 channel = ieee80211_chan2ieee(ic, c); 961 if (channel == 0 || channel == IEEE80211_CHAN_ANY) { 962 /* XXX should NEVER happen */ 963 device_printf(sc->sc_dev, 964 "%s: invalid channel %x\n", __func__, channel); 965 return; 966 } 967 968 DPRINTF(sc, UPGT_DEBUG_STATE, "%s: channel %d\n", __func__, channel); 969 970 data_cmd = upgt_getbuf(sc); 971 if (data_cmd == NULL) { 972 device_printf(sc->sc_dev, "%s: out of buffers.\n", __func__); 973 return; 974 } 975 /* 976 * Transmit the URB containing the CMD data. 977 */ 978 memset(data_cmd->buf, 0, MCLBYTES); 979 980 mem = (struct upgt_lmac_mem *)data_cmd->buf; 981 mem->addr = htole32(sc->sc_memaddr_frame_start + 982 UPGT_MEMSIZE_FRAME_HEAD); 983 984 chan = (struct upgt_lmac_channel *)(mem + 1); 985 986 chan->header1.flags = UPGT_H1_FLAGS_TX_NO_CALLBACK; 987 chan->header1.type = UPGT_H1_TYPE_CTRL; 988 chan->header1.len = htole16( 989 sizeof(struct upgt_lmac_channel) - sizeof(struct upgt_lmac_header)); 990 991 chan->header2.reqid = htole32(sc->sc_memaddr_frame_start); 992 chan->header2.type = htole16(UPGT_H2_TYPE_CHANNEL); 993 chan->header2.flags = 0; 994 995 chan->unknown1 = htole16(UPGT_CHANNEL_UNKNOWN1); 996 chan->unknown2 = htole16(UPGT_CHANNEL_UNKNOWN2); 997 chan->freq6 = sc->sc_eeprom_freq6[channel]; 998 chan->settings = sc->sc_eeprom_freq6_settings; 999 chan->unknown3 = UPGT_CHANNEL_UNKNOWN3; 1000 1001 memcpy(chan->freq3_1, &sc->sc_eeprom_freq3[channel].data, 1002 sizeof(chan->freq3_1)); 1003 memcpy(chan->freq4, &sc->sc_eeprom_freq4[channel], 1004 sizeof(sc->sc_eeprom_freq4[channel])); 1005 memcpy(chan->freq3_2, &sc->sc_eeprom_freq3[channel].data, 1006 sizeof(chan->freq3_2)); 1007 1008 data_cmd->buflen = sizeof(*mem) + sizeof(*chan); 1009 1010 mem->chksum = upgt_chksum_le((uint32_t *)chan, 1011 data_cmd->buflen - sizeof(*mem)); 1012 1013 upgt_bulk_tx(sc, data_cmd); 1014} 1015 1016static struct ieee80211vap * 1017upgt_vap_create(struct ieee80211com *ic, const char name[IFNAMSIZ], int unit, 1018 enum ieee80211_opmode opmode, int flags, 1019 const uint8_t bssid[IEEE80211_ADDR_LEN], 1020 const uint8_t mac[IEEE80211_ADDR_LEN]) 1021{ 1022 struct upgt_vap *uvp; 1023 struct ieee80211vap *vap; 1024 1025 if (!TAILQ_EMPTY(&ic->ic_vaps)) /* only one at a time */ 1026 return NULL; 1027 uvp = (struct upgt_vap *) malloc(sizeof(struct upgt_vap), 1028 M_80211_VAP, M_NOWAIT | M_ZERO); 1029 if (uvp == NULL) 1030 return NULL; 1031 vap = &uvp->vap; 1032 /* enable s/w bmiss handling for sta mode */ 1033 ieee80211_vap_setup(ic, vap, name, unit, opmode, 1034 flags | IEEE80211_CLONE_NOBEACONS, bssid, mac); 1035 1036 /* override state transition machine */ 1037 uvp->newstate = vap->iv_newstate; 1038 vap->iv_newstate = upgt_newstate; 1039 1040 /* setup device rates */ 1041 upgt_setup_rates(vap, ic); 1042 1043 /* complete setup */ 1044 ieee80211_vap_attach(vap, ieee80211_media_change, 1045 ieee80211_media_status); 1046 ic->ic_opmode = opmode; 1047 return vap; 1048} 1049 1050static int 1051upgt_newstate(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 1052{ 1053 struct upgt_vap *uvp = UPGT_VAP(vap); 1054 struct ieee80211com *ic = vap->iv_ic; 1055 struct upgt_softc *sc = ic->ic_ifp->if_softc; 1056 1057 /* do it in a process context */ 1058 sc->sc_state = nstate; 1059 1060 IEEE80211_UNLOCK(ic); 1061 UPGT_LOCK(sc); 1062 callout_stop(&sc->sc_led_ch); 1063 callout_stop(&sc->sc_watchdog_ch); 1064 1065 switch (nstate) { 1066 case IEEE80211_S_INIT: 1067 /* do not accept any frames if the device is down */ 1068 (void)upgt_set_macfilter(sc, sc->sc_state); 1069 upgt_set_led(sc, UPGT_LED_OFF); 1070 break; 1071 case IEEE80211_S_SCAN: 1072 upgt_set_chan(sc, ic->ic_curchan); 1073 break; 1074 case IEEE80211_S_AUTH: 1075 upgt_set_chan(sc, ic->ic_curchan); 1076 break; 1077 case IEEE80211_S_ASSOC: 1078 break; 1079 case IEEE80211_S_RUN: 1080 upgt_set_macfilter(sc, sc->sc_state); 1081 upgt_set_led(sc, UPGT_LED_ON); 1082 break; 1083 default: 1084 break; 1085 } 1086 UPGT_UNLOCK(sc); 1087 IEEE80211_LOCK(ic); 1088 return (uvp->newstate(vap, nstate, arg)); 1089} 1090 1091static void 1092upgt_vap_delete(struct ieee80211vap *vap) 1093{ 1094 struct upgt_vap *uvp = UPGT_VAP(vap); 1095 1096 ieee80211_vap_detach(vap); 1097 free(uvp, M_80211_VAP); 1098} 1099 1100static void 1101upgt_update_mcast(struct ifnet *ifp) 1102{ 1103 struct upgt_softc *sc = ifp->if_softc; 1104 1105 upgt_set_multi(sc); 1106} 1107 1108static int 1109upgt_eeprom_parse(struct upgt_softc *sc) 1110{ 1111 struct upgt_eeprom_header *eeprom_header; 1112 struct upgt_eeprom_option *eeprom_option; 1113 uint16_t option_len; 1114 uint16_t option_type; 1115 uint16_t preamble_len; 1116 int option_end = 0; 1117 1118 /* calculate eeprom options start offset */ 1119 eeprom_header = (struct upgt_eeprom_header *)sc->sc_eeprom; 1120 preamble_len = le16toh(eeprom_header->preamble_len); 1121 eeprom_option = (struct upgt_eeprom_option *)(sc->sc_eeprom + 1122 (sizeof(struct upgt_eeprom_header) + preamble_len)); 1123 1124 while (!option_end) { 1125 /* the eeprom option length is stored in words */ 1126 option_len = 1127 (le16toh(eeprom_option->len) - 1) * sizeof(uint16_t); 1128 option_type = 1129 le16toh(eeprom_option->type); 1130 1131 switch (option_type) { 1132 case UPGT_EEPROM_TYPE_NAME: 1133 DPRINTF(sc, UPGT_DEBUG_FW, 1134 "EEPROM name len=%d\n", option_len); 1135 break; 1136 case UPGT_EEPROM_TYPE_SERIAL: 1137 DPRINTF(sc, UPGT_DEBUG_FW, 1138 "EEPROM serial len=%d\n", option_len); 1139 break; 1140 case UPGT_EEPROM_TYPE_MAC: 1141 DPRINTF(sc, UPGT_DEBUG_FW, 1142 "EEPROM mac len=%d\n", option_len); 1143 1144 IEEE80211_ADDR_COPY(sc->sc_myaddr, eeprom_option->data); 1145 break; 1146 case UPGT_EEPROM_TYPE_HWRX: 1147 DPRINTF(sc, UPGT_DEBUG_FW, 1148 "EEPROM hwrx len=%d\n", option_len); 1149 1150 upgt_eeprom_parse_hwrx(sc, eeprom_option->data); 1151 break; 1152 case UPGT_EEPROM_TYPE_CHIP: 1153 DPRINTF(sc, UPGT_DEBUG_FW, 1154 "EEPROM chip len=%d\n", option_len); 1155 break; 1156 case UPGT_EEPROM_TYPE_FREQ3: 1157 DPRINTF(sc, UPGT_DEBUG_FW, 1158 "EEPROM freq3 len=%d\n", option_len); 1159 1160 upgt_eeprom_parse_freq3(sc, eeprom_option->data, 1161 option_len); 1162 break; 1163 case UPGT_EEPROM_TYPE_FREQ4: 1164 DPRINTF(sc, UPGT_DEBUG_FW, 1165 "EEPROM freq4 len=%d\n", option_len); 1166 1167 upgt_eeprom_parse_freq4(sc, eeprom_option->data, 1168 option_len); 1169 break; 1170 case UPGT_EEPROM_TYPE_FREQ5: 1171 DPRINTF(sc, UPGT_DEBUG_FW, 1172 "EEPROM freq5 len=%d\n", option_len); 1173 break; 1174 case UPGT_EEPROM_TYPE_FREQ6: 1175 DPRINTF(sc, UPGT_DEBUG_FW, 1176 "EEPROM freq6 len=%d\n", option_len); 1177 1178 upgt_eeprom_parse_freq6(sc, eeprom_option->data, 1179 option_len); 1180 break; 1181 case UPGT_EEPROM_TYPE_END: 1182 DPRINTF(sc, UPGT_DEBUG_FW, 1183 "EEPROM end len=%d\n", option_len); 1184 option_end = 1; 1185 break; 1186 case UPGT_EEPROM_TYPE_OFF: 1187 DPRINTF(sc, UPGT_DEBUG_FW, 1188 "%s: EEPROM off without end option\n", __func__); 1189 return (EIO); 1190 default: 1191 DPRINTF(sc, UPGT_DEBUG_FW, 1192 "EEPROM unknown type 0x%04x len=%d\n", 1193 option_type, option_len); 1194 break; 1195 } 1196 1197 /* jump to next EEPROM option */ 1198 eeprom_option = (struct upgt_eeprom_option *) 1199 (eeprom_option->data + option_len); 1200 } 1201 1202 return (0); 1203} 1204 1205static void 1206upgt_eeprom_parse_freq3(struct upgt_softc *sc, uint8_t *data, int len) 1207{ 1208 struct upgt_eeprom_freq3_header *freq3_header; 1209 struct upgt_lmac_freq3 *freq3; 1210 int i, elements, flags; 1211 unsigned channel; 1212 1213 freq3_header = (struct upgt_eeprom_freq3_header *)data; 1214 freq3 = (struct upgt_lmac_freq3 *)(freq3_header + 1); 1215 1216 flags = freq3_header->flags; 1217 elements = freq3_header->elements; 1218 1219 DPRINTF(sc, UPGT_DEBUG_FW, "flags=0x%02x elements=%d\n", 1220 flags, elements); 1221 1222 for (i = 0; i < elements; i++) { 1223 channel = ieee80211_mhz2ieee(le16toh(freq3[i].freq), 0); 1224 if (channel >= IEEE80211_CHAN_MAX) 1225 continue; 1226 1227 sc->sc_eeprom_freq3[channel] = freq3[i]; 1228 1229 DPRINTF(sc, UPGT_DEBUG_FW, "frequence=%d, channel=%d\n", 1230 le16toh(sc->sc_eeprom_freq3[channel].freq), channel); 1231 } 1232} 1233 1234void 1235upgt_eeprom_parse_freq4(struct upgt_softc *sc, uint8_t *data, int len) 1236{ 1237 struct upgt_eeprom_freq4_header *freq4_header; 1238 struct upgt_eeprom_freq4_1 *freq4_1; 1239 struct upgt_eeprom_freq4_2 *freq4_2; 1240 int i, j, elements, settings, flags; 1241 unsigned channel; 1242 1243 freq4_header = (struct upgt_eeprom_freq4_header *)data; 1244 freq4_1 = (struct upgt_eeprom_freq4_1 *)(freq4_header + 1); 1245 flags = freq4_header->flags; 1246 elements = freq4_header->elements; 1247 settings = freq4_header->settings; 1248 1249 /* we need this value later */ 1250 sc->sc_eeprom_freq6_settings = freq4_header->settings; 1251 1252 DPRINTF(sc, UPGT_DEBUG_FW, "flags=0x%02x elements=%d settings=%d\n", 1253 flags, elements, settings); 1254 1255 for (i = 0; i < elements; i++) { 1256 channel = ieee80211_mhz2ieee(le16toh(freq4_1[i].freq), 0); 1257 if (channel >= IEEE80211_CHAN_MAX) 1258 continue; 1259 1260 freq4_2 = (struct upgt_eeprom_freq4_2 *)freq4_1[i].data; 1261 for (j = 0; j < settings; j++) { 1262 sc->sc_eeprom_freq4[channel][j].cmd = freq4_2[j]; 1263 sc->sc_eeprom_freq4[channel][j].pad = 0; 1264 } 1265 1266 DPRINTF(sc, UPGT_DEBUG_FW, "frequence=%d, channel=%d\n", 1267 le16toh(freq4_1[i].freq), channel); 1268 } 1269} 1270 1271void 1272upgt_eeprom_parse_freq6(struct upgt_softc *sc, uint8_t *data, int len) 1273{ 1274 struct upgt_lmac_freq6 *freq6; 1275 int i, elements; 1276 unsigned channel; 1277 1278 freq6 = (struct upgt_lmac_freq6 *)data; 1279 elements = len / sizeof(struct upgt_lmac_freq6); 1280 1281 DPRINTF(sc, UPGT_DEBUG_FW, "elements=%d\n", elements); 1282 1283 for (i = 0; i < elements; i++) { 1284 channel = ieee80211_mhz2ieee(le16toh(freq6[i].freq), 0); 1285 if (channel >= IEEE80211_CHAN_MAX) 1286 continue; 1287 1288 sc->sc_eeprom_freq6[channel] = freq6[i]; 1289 1290 DPRINTF(sc, UPGT_DEBUG_FW, "frequence=%d, channel=%d\n", 1291 le16toh(sc->sc_eeprom_freq6[channel].freq), channel); 1292 } 1293} 1294 1295static void 1296upgt_eeprom_parse_hwrx(struct upgt_softc *sc, uint8_t *data) 1297{ 1298 struct upgt_eeprom_option_hwrx *option_hwrx; 1299 1300 option_hwrx = (struct upgt_eeprom_option_hwrx *)data; 1301 1302 sc->sc_eeprom_hwrx = option_hwrx->rxfilter - UPGT_EEPROM_RX_CONST; 1303 1304 DPRINTF(sc, UPGT_DEBUG_FW, "hwrx option value=0x%04x\n", 1305 sc->sc_eeprom_hwrx); 1306} 1307 1308static int 1309upgt_eeprom_read(struct upgt_softc *sc) 1310{ 1311 struct upgt_data *data_cmd; 1312 struct upgt_lmac_mem *mem; 1313 struct upgt_lmac_eeprom *eeprom; 1314 int block, error, offset; 1315 1316 UPGT_LOCK(sc); 1317 usb_pause_mtx(&sc->sc_mtx, 100); 1318 1319 offset = 0; 1320 block = UPGT_EEPROM_BLOCK_SIZE; 1321 while (offset < UPGT_EEPROM_SIZE) { 1322 DPRINTF(sc, UPGT_DEBUG_FW, 1323 "request EEPROM block (offset=%d, len=%d)\n", offset, block); 1324 1325 data_cmd = upgt_getbuf(sc); 1326 if (data_cmd == NULL) { 1327 UPGT_UNLOCK(sc); 1328 return (ENOBUFS); 1329 } 1330 1331 /* 1332 * Transmit the URB containing the CMD data. 1333 */ 1334 memset(data_cmd->buf, 0, MCLBYTES); 1335 1336 mem = (struct upgt_lmac_mem *)data_cmd->buf; 1337 mem->addr = htole32(sc->sc_memaddr_frame_start + 1338 UPGT_MEMSIZE_FRAME_HEAD); 1339 1340 eeprom = (struct upgt_lmac_eeprom *)(mem + 1); 1341 eeprom->header1.flags = 0; 1342 eeprom->header1.type = UPGT_H1_TYPE_CTRL; 1343 eeprom->header1.len = htole16(( 1344 sizeof(struct upgt_lmac_eeprom) - 1345 sizeof(struct upgt_lmac_header)) + block); 1346 1347 eeprom->header2.reqid = htole32(sc->sc_memaddr_frame_start); 1348 eeprom->header2.type = htole16(UPGT_H2_TYPE_EEPROM); 1349 eeprom->header2.flags = 0; 1350 1351 eeprom->offset = htole16(offset); 1352 eeprom->len = htole16(block); 1353 1354 data_cmd->buflen = sizeof(*mem) + sizeof(*eeprom) + block; 1355 1356 mem->chksum = upgt_chksum_le((uint32_t *)eeprom, 1357 data_cmd->buflen - sizeof(*mem)); 1358 upgt_bulk_tx(sc, data_cmd); 1359 1360 error = mtx_sleep(sc, &sc->sc_mtx, 0, "eeprom_request", hz); 1361 if (error != 0) { 1362 device_printf(sc->sc_dev, 1363 "timeout while waiting for EEPROM data\n"); 1364 UPGT_UNLOCK(sc); 1365 return (EIO); 1366 } 1367 1368 offset += block; 1369 if (UPGT_EEPROM_SIZE - offset < block) 1370 block = UPGT_EEPROM_SIZE - offset; 1371 } 1372 1373 UPGT_UNLOCK(sc); 1374 return (0); 1375} 1376 1377/* 1378 * When a rx data came in the function returns a mbuf and a rssi values. 1379 */ 1380static struct mbuf * 1381upgt_rxeof(struct usb_xfer *xfer, struct upgt_data *data, int *rssi) 1382{ 1383 struct mbuf *m = NULL; 1384 struct upgt_softc *sc = usbd_xfer_softc(xfer); 1385 struct upgt_lmac_header *header; 1386 struct upgt_lmac_eeprom *eeprom; 1387 uint8_t h1_type; 1388 uint16_t h2_type; 1389 int actlen, sumlen; 1390 1391 usbd_xfer_status(xfer, &actlen, &sumlen, NULL, NULL); 1392 1393 UPGT_ASSERT_LOCKED(sc); 1394 1395 if (actlen < 1) 1396 return (NULL); 1397 1398 /* Check only at the very beginning. */ 1399 if (!(sc->sc_flags & UPGT_FLAG_FWLOADED) && 1400 (memcmp(data->buf, "OK", 2) == 0)) { 1401 sc->sc_flags |= UPGT_FLAG_FWLOADED; 1402 wakeup_one(sc); 1403 return (NULL); 1404 } 1405 1406 if (actlen < (int)UPGT_RX_MINSZ) 1407 return (NULL); 1408 1409 /* 1410 * Check what type of frame came in. 1411 */ 1412 header = (struct upgt_lmac_header *)(data->buf + 4); 1413 1414 h1_type = header->header1.type; 1415 h2_type = le16toh(header->header2.type); 1416 1417 if (h1_type == UPGT_H1_TYPE_CTRL && h2_type == UPGT_H2_TYPE_EEPROM) { 1418 eeprom = (struct upgt_lmac_eeprom *)(data->buf + 4); 1419 uint16_t eeprom_offset = le16toh(eeprom->offset); 1420 uint16_t eeprom_len = le16toh(eeprom->len); 1421 1422 DPRINTF(sc, UPGT_DEBUG_FW, 1423 "received EEPROM block (offset=%d, len=%d)\n", 1424 eeprom_offset, eeprom_len); 1425 1426 memcpy(sc->sc_eeprom + eeprom_offset, 1427 data->buf + sizeof(struct upgt_lmac_eeprom) + 4, 1428 eeprom_len); 1429 1430 /* EEPROM data has arrived in time, wakeup. */ 1431 wakeup(sc); 1432 } else if (h1_type == UPGT_H1_TYPE_CTRL && 1433 h2_type == UPGT_H2_TYPE_TX_DONE) { 1434 DPRINTF(sc, UPGT_DEBUG_XMIT, "%s: received 802.11 TX done\n", 1435 __func__); 1436 upgt_tx_done(sc, data->buf + 4); 1437 } else if (h1_type == UPGT_H1_TYPE_RX_DATA || 1438 h1_type == UPGT_H1_TYPE_RX_DATA_MGMT) { 1439 DPRINTF(sc, UPGT_DEBUG_RECV, "%s: received 802.11 RX data\n", 1440 __func__); 1441 m = upgt_rx(sc, data->buf + 4, le16toh(header->header1.len), 1442 rssi); 1443 } else if (h1_type == UPGT_H1_TYPE_CTRL && 1444 h2_type == UPGT_H2_TYPE_STATS) { 1445 DPRINTF(sc, UPGT_DEBUG_STAT, "%s: received statistic data\n", 1446 __func__); 1447 /* TODO: what could we do with the statistic data? */ 1448 } else { 1449 /* ignore unknown frame types */ 1450 DPRINTF(sc, UPGT_DEBUG_INTR, 1451 "received unknown frame type 0x%02x\n", 1452 header->header1.type); 1453 } 1454 return (m); 1455} 1456 1457/* 1458 * The firmware awaits a checksum for each frame we send to it. 1459 * The algorithm used therefor is uncommon but somehow similar to CRC32. 1460 */ 1461static uint32_t 1462upgt_chksum_le(const uint32_t *buf, size_t size) 1463{ 1464 size_t i; 1465 uint32_t crc = 0; 1466 1467 for (i = 0; i < size; i += sizeof(uint32_t)) { 1468 crc = htole32(crc ^ *buf++); 1469 crc = htole32((crc >> 5) ^ (crc << 3)); 1470 } 1471 1472 return (crc); 1473} 1474 1475static struct mbuf * 1476upgt_rx(struct upgt_softc *sc, uint8_t *data, int pkglen, int *rssi) 1477{ 1478 struct ifnet *ifp = sc->sc_ifp; 1479 struct ieee80211com *ic = ifp->if_l2com; 1480 struct upgt_lmac_rx_desc *rxdesc; 1481 struct mbuf *m; 1482 1483 /* 1484 * don't pass packets to the ieee80211 framework if the driver isn't 1485 * RUNNING. 1486 */ 1487 if (!(ifp->if_drv_flags & IFF_DRV_RUNNING)) 1488 return (NULL); 1489 1490 /* access RX packet descriptor */ 1491 rxdesc = (struct upgt_lmac_rx_desc *)data; 1492 1493 /* create mbuf which is suitable for strict alignment archs */ 1494 KASSERT((pkglen + ETHER_ALIGN) < MCLBYTES, 1495 ("A current mbuf storage is small (%d)", pkglen + ETHER_ALIGN)); 1496 m = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR); 1497 if (m == NULL) { 1498 device_printf(sc->sc_dev, "could not create RX mbuf\n"); 1499 return (NULL); 1500 } 1501 m_adj(m, ETHER_ALIGN); 1502 memcpy(mtod(m, char *), rxdesc->data, pkglen); 1503 /* trim FCS */ 1504 m->m_len = m->m_pkthdr.len = pkglen - IEEE80211_CRC_LEN; 1505 m->m_pkthdr.rcvif = ifp; 1506 1507 if (ieee80211_radiotap_active(ic)) { 1508 struct upgt_rx_radiotap_header *tap = &sc->sc_rxtap; 1509 1510 tap->wr_flags = 0; 1511 tap->wr_rate = upgt_rx_rate(sc, rxdesc->rate); 1512 tap->wr_antsignal = rxdesc->rssi; 1513 } 1514 ifp->if_ipackets++; 1515 1516 DPRINTF(sc, UPGT_DEBUG_RX_PROC, "%s: RX done\n", __func__); 1517 *rssi = rxdesc->rssi; 1518 return (m); 1519} 1520 1521static uint8_t 1522upgt_rx_rate(struct upgt_softc *sc, const int rate) 1523{ 1524 struct ifnet *ifp = sc->sc_ifp; 1525 struct ieee80211com *ic = ifp->if_l2com; 1526 static const uint8_t cck_upgt2rate[4] = { 2, 4, 11, 22 }; 1527 static const uint8_t ofdm_upgt2rate[12] = 1528 { 2, 4, 11, 22, 12, 18, 24, 36, 48, 72, 96, 108 }; 1529 1530 if (ic->ic_curmode == IEEE80211_MODE_11B && 1531 !(rate < 0 || rate > 3)) 1532 return cck_upgt2rate[rate & 0xf]; 1533 1534 if (ic->ic_curmode == IEEE80211_MODE_11G && 1535 !(rate < 0 || rate > 11)) 1536 return ofdm_upgt2rate[rate & 0xf]; 1537 1538 return (0); 1539} 1540 1541static void 1542upgt_tx_done(struct upgt_softc *sc, uint8_t *data) 1543{ 1544 struct ifnet *ifp = sc->sc_ifp; 1545 struct upgt_lmac_tx_done_desc *desc; 1546 int i, freed = 0; 1547 1548 UPGT_ASSERT_LOCKED(sc); 1549 1550 desc = (struct upgt_lmac_tx_done_desc *)data; 1551 1552 for (i = 0; i < UPGT_TX_MAXCOUNT; i++) { 1553 struct upgt_data *data_tx = &sc->sc_tx_data[i]; 1554 1555 if (data_tx->addr == le32toh(desc->header2.reqid)) { 1556 upgt_mem_free(sc, data_tx->addr); 1557 data_tx->ni = NULL; 1558 data_tx->addr = 0; 1559 data_tx->m = NULL; 1560 data_tx->use = 0; 1561 1562 DPRINTF(sc, UPGT_DEBUG_TX_PROC, 1563 "TX done: memaddr=0x%08x, status=0x%04x, rssi=%d, ", 1564 le32toh(desc->header2.reqid), 1565 le16toh(desc->status), le16toh(desc->rssi)); 1566 DPRINTF(sc, UPGT_DEBUG_TX_PROC, "seq=%d\n", 1567 le16toh(desc->seq)); 1568 1569 freed++; 1570 } 1571 } 1572 1573 if (freed != 0) { 1574 sc->sc_tx_timer = 0; 1575 ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 1576 UPGT_UNLOCK(sc); 1577 upgt_start(ifp); 1578 UPGT_LOCK(sc); 1579 } 1580} 1581 1582static void 1583upgt_mem_free(struct upgt_softc *sc, uint32_t addr) 1584{ 1585 int i; 1586 1587 for (i = 0; i < sc->sc_memory.pages; i++) { 1588 if (sc->sc_memory.page[i].addr == addr) { 1589 sc->sc_memory.page[i].used = 0; 1590 return; 1591 } 1592 } 1593 1594 device_printf(sc->sc_dev, 1595 "could not free memory address 0x%08x\n", addr); 1596} 1597 1598static int 1599upgt_fw_load(struct upgt_softc *sc) 1600{ 1601 const struct firmware *fw; 1602 struct upgt_data *data_cmd; 1603 struct upgt_fw_x2_header *x2; 1604 char start_fwload_cmd[] = { 0x3c, 0x0d }; 1605 int error = 0; 1606 size_t offset; 1607 int bsize; 1608 int n; 1609 uint32_t crc32; 1610 1611 fw = firmware_get(upgt_fwname); 1612 if (fw == NULL) { 1613 device_printf(sc->sc_dev, "could not read microcode %s\n", 1614 upgt_fwname); 1615 return (EIO); 1616 } 1617 1618 UPGT_LOCK(sc); 1619 1620 /* send firmware start load command */ 1621 data_cmd = upgt_getbuf(sc); 1622 if (data_cmd == NULL) { 1623 error = ENOBUFS; 1624 goto fail; 1625 } 1626 data_cmd->buflen = sizeof(start_fwload_cmd); 1627 memcpy(data_cmd->buf, start_fwload_cmd, data_cmd->buflen); 1628 upgt_bulk_tx(sc, data_cmd); 1629 1630 /* send X2 header */ 1631 data_cmd = upgt_getbuf(sc); 1632 if (data_cmd == NULL) { 1633 error = ENOBUFS; 1634 goto fail; 1635 } 1636 data_cmd->buflen = sizeof(struct upgt_fw_x2_header); 1637 x2 = (struct upgt_fw_x2_header *)data_cmd->buf; 1638 memcpy(x2->signature, UPGT_X2_SIGNATURE, UPGT_X2_SIGNATURE_SIZE); 1639 x2->startaddr = htole32(UPGT_MEMADDR_FIRMWARE_START); 1640 x2->len = htole32(fw->datasize); 1641 x2->crc = upgt_crc32_le((uint8_t *)data_cmd->buf + 1642 UPGT_X2_SIGNATURE_SIZE, 1643 sizeof(struct upgt_fw_x2_header) - UPGT_X2_SIGNATURE_SIZE - 1644 sizeof(uint32_t)); 1645 upgt_bulk_tx(sc, data_cmd); 1646 1647 /* download firmware */ 1648 for (offset = 0; offset < fw->datasize; offset += bsize) { 1649 if (fw->datasize - offset > UPGT_FW_BLOCK_SIZE) 1650 bsize = UPGT_FW_BLOCK_SIZE; 1651 else 1652 bsize = fw->datasize - offset; 1653 1654 data_cmd = upgt_getbuf(sc); 1655 if (data_cmd == NULL) { 1656 error = ENOBUFS; 1657 goto fail; 1658 } 1659 n = upgt_fw_copy((const uint8_t *)fw->data + offset, 1660 data_cmd->buf, bsize); 1661 data_cmd->buflen = bsize; 1662 upgt_bulk_tx(sc, data_cmd); 1663 1664 DPRINTF(sc, UPGT_DEBUG_FW, "FW offset=%d, read=%d, sent=%d\n", 1665 offset, n, bsize); 1666 bsize = n; 1667 } 1668 DPRINTF(sc, UPGT_DEBUG_FW, "%s: firmware downloaded\n", __func__); 1669 1670 /* load firmware */ 1671 data_cmd = upgt_getbuf(sc); 1672 if (data_cmd == NULL) { 1673 error = ENOBUFS; 1674 goto fail; 1675 } 1676 crc32 = upgt_crc32_le(fw->data, fw->datasize); 1677 *((uint32_t *)(data_cmd->buf) ) = crc32; 1678 *((uint8_t *)(data_cmd->buf) + 4) = 'g'; 1679 *((uint8_t *)(data_cmd->buf) + 5) = '\r'; 1680 data_cmd->buflen = 6; 1681 upgt_bulk_tx(sc, data_cmd); 1682 1683 /* waiting 'OK' response. */ 1684 usbd_transfer_start(sc->sc_xfer[UPGT_BULK_RX]); 1685 error = mtx_sleep(sc, &sc->sc_mtx, 0, "upgtfw", 2 * hz); 1686 if (error != 0) { 1687 device_printf(sc->sc_dev, "firmware load failed\n"); 1688 error = EIO; 1689 } 1690 1691 DPRINTF(sc, UPGT_DEBUG_FW, "%s: firmware loaded\n", __func__); 1692fail: 1693 UPGT_UNLOCK(sc); 1694 firmware_put(fw, FIRMWARE_UNLOAD); 1695 return (error); 1696} 1697 1698static uint32_t 1699upgt_crc32_le(const void *buf, size_t size) 1700{ 1701 uint32_t crc; 1702 1703 crc = ether_crc32_le(buf, size); 1704 1705 /* apply final XOR value as common for CRC-32 */ 1706 crc = htole32(crc ^ 0xffffffffU); 1707 1708 return (crc); 1709} 1710 1711/* 1712 * While copying the version 2 firmware, we need to replace two characters: 1713 * 1714 * 0x7e -> 0x7d 0x5e 1715 * 0x7d -> 0x7d 0x5d 1716 */ 1717static int 1718upgt_fw_copy(const uint8_t *src, char *dst, int size) 1719{ 1720 int i, j; 1721 1722 for (i = 0, j = 0; i < size && j < size; i++) { 1723 switch (src[i]) { 1724 case 0x7e: 1725 dst[j] = 0x7d; 1726 j++; 1727 dst[j] = 0x5e; 1728 j++; 1729 break; 1730 case 0x7d: 1731 dst[j] = 0x7d; 1732 j++; 1733 dst[j] = 0x5d; 1734 j++; 1735 break; 1736 default: 1737 dst[j] = src[i]; 1738 j++; 1739 break; 1740 } 1741 } 1742 1743 return (i); 1744} 1745 1746static int 1747upgt_mem_init(struct upgt_softc *sc) 1748{ 1749 int i; 1750 1751 for (i = 0; i < UPGT_MEMORY_MAX_PAGES; i++) { 1752 sc->sc_memory.page[i].used = 0; 1753 1754 if (i == 0) { 1755 /* 1756 * The first memory page is always reserved for 1757 * command data. 1758 */ 1759 sc->sc_memory.page[i].addr = 1760 sc->sc_memaddr_frame_start + MCLBYTES; 1761 } else { 1762 sc->sc_memory.page[i].addr = 1763 sc->sc_memory.page[i - 1].addr + MCLBYTES; 1764 } 1765 1766 if (sc->sc_memory.page[i].addr + MCLBYTES >= 1767 sc->sc_memaddr_frame_end) 1768 break; 1769 1770 DPRINTF(sc, UPGT_DEBUG_FW, "memory address page %d=0x%08x\n", 1771 i, sc->sc_memory.page[i].addr); 1772 } 1773 1774 sc->sc_memory.pages = i; 1775 1776 DPRINTF(sc, UPGT_DEBUG_FW, "memory pages=%d\n", sc->sc_memory.pages); 1777 return (0); 1778} 1779 1780static int 1781upgt_fw_verify(struct upgt_softc *sc) 1782{ 1783 const struct firmware *fw; 1784 const struct upgt_fw_bra_option *bra_opt; 1785 const struct upgt_fw_bra_descr *descr; 1786 const uint8_t *p; 1787 const uint32_t *uc; 1788 uint32_t bra_option_type, bra_option_len; 1789 size_t offset; 1790 int bra_end = 0; 1791 int error = 0; 1792 1793 fw = firmware_get(upgt_fwname); 1794 if (fw == NULL) { 1795 device_printf(sc->sc_dev, "could not read microcode %s\n", 1796 upgt_fwname); 1797 return EIO; 1798 } 1799 1800 /* 1801 * Seek to beginning of Boot Record Area (BRA). 1802 */ 1803 for (offset = 0; offset < fw->datasize; offset += sizeof(*uc)) { 1804 uc = (const uint32_t *)((const uint8_t *)fw->data + offset); 1805 if (*uc == 0) 1806 break; 1807 } 1808 for (; offset < fw->datasize; offset += sizeof(*uc)) { 1809 uc = (const uint32_t *)((const uint8_t *)fw->data + offset); 1810 if (*uc != 0) 1811 break; 1812 } 1813 if (offset == fw->datasize) { 1814 device_printf(sc->sc_dev, 1815 "firmware Boot Record Area not found\n"); 1816 error = EIO; 1817 goto fail; 1818 } 1819 1820 DPRINTF(sc, UPGT_DEBUG_FW, 1821 "firmware Boot Record Area found at offset %d\n", offset); 1822 1823 /* 1824 * Parse Boot Record Area (BRA) options. 1825 */ 1826 while (offset < fw->datasize && bra_end == 0) { 1827 /* get current BRA option */ 1828 p = (const uint8_t *)fw->data + offset; 1829 bra_opt = (const struct upgt_fw_bra_option *)p; 1830 bra_option_type = le32toh(bra_opt->type); 1831 bra_option_len = le32toh(bra_opt->len) * sizeof(*uc); 1832 1833 switch (bra_option_type) { 1834 case UPGT_BRA_TYPE_FW: 1835 DPRINTF(sc, UPGT_DEBUG_FW, "UPGT_BRA_TYPE_FW len=%d\n", 1836 bra_option_len); 1837 1838 if (bra_option_len != UPGT_BRA_FWTYPE_SIZE) { 1839 device_printf(sc->sc_dev, 1840 "wrong UPGT_BRA_TYPE_FW len\n"); 1841 error = EIO; 1842 goto fail; 1843 } 1844 if (memcmp(UPGT_BRA_FWTYPE_LM86, bra_opt->data, 1845 bra_option_len) == 0) { 1846 sc->sc_fw_type = UPGT_FWTYPE_LM86; 1847 break; 1848 } 1849 if (memcmp(UPGT_BRA_FWTYPE_LM87, bra_opt->data, 1850 bra_option_len) == 0) { 1851 sc->sc_fw_type = UPGT_FWTYPE_LM87; 1852 break; 1853 } 1854 device_printf(sc->sc_dev, 1855 "unsupported firmware type\n"); 1856 error = EIO; 1857 goto fail; 1858 case UPGT_BRA_TYPE_VERSION: 1859 DPRINTF(sc, UPGT_DEBUG_FW, 1860 "UPGT_BRA_TYPE_VERSION len=%d\n", bra_option_len); 1861 break; 1862 case UPGT_BRA_TYPE_DEPIF: 1863 DPRINTF(sc, UPGT_DEBUG_FW, 1864 "UPGT_BRA_TYPE_DEPIF len=%d\n", bra_option_len); 1865 break; 1866 case UPGT_BRA_TYPE_EXPIF: 1867 DPRINTF(sc, UPGT_DEBUG_FW, 1868 "UPGT_BRA_TYPE_EXPIF len=%d\n", bra_option_len); 1869 break; 1870 case UPGT_BRA_TYPE_DESCR: 1871 DPRINTF(sc, UPGT_DEBUG_FW, 1872 "UPGT_BRA_TYPE_DESCR len=%d\n", bra_option_len); 1873 1874 descr = (const struct upgt_fw_bra_descr *)bra_opt->data; 1875 1876 sc->sc_memaddr_frame_start = 1877 le32toh(descr->memaddr_space_start); 1878 sc->sc_memaddr_frame_end = 1879 le32toh(descr->memaddr_space_end); 1880 1881 DPRINTF(sc, UPGT_DEBUG_FW, 1882 "memory address space start=0x%08x\n", 1883 sc->sc_memaddr_frame_start); 1884 DPRINTF(sc, UPGT_DEBUG_FW, 1885 "memory address space end=0x%08x\n", 1886 sc->sc_memaddr_frame_end); 1887 break; 1888 case UPGT_BRA_TYPE_END: 1889 DPRINTF(sc, UPGT_DEBUG_FW, "UPGT_BRA_TYPE_END len=%d\n", 1890 bra_option_len); 1891 bra_end = 1; 1892 break; 1893 default: 1894 DPRINTF(sc, UPGT_DEBUG_FW, "unknown BRA option len=%d\n", 1895 bra_option_len); 1896 error = EIO; 1897 goto fail; 1898 } 1899 1900 /* jump to next BRA option */ 1901 offset += sizeof(struct upgt_fw_bra_option) + bra_option_len; 1902 } 1903 1904 DPRINTF(sc, UPGT_DEBUG_FW, "%s: firmware verified", __func__); 1905fail: 1906 firmware_put(fw, FIRMWARE_UNLOAD); 1907 return (error); 1908} 1909 1910static void 1911upgt_bulk_tx(struct upgt_softc *sc, struct upgt_data *data) 1912{ 1913 1914 UPGT_ASSERT_LOCKED(sc); 1915 1916 STAILQ_INSERT_TAIL(&sc->sc_tx_pending, data, next); 1917 UPGT_STAT_INC(sc, st_tx_pending); 1918 usbd_transfer_start(sc->sc_xfer[UPGT_BULK_TX]); 1919} 1920 1921static int 1922upgt_device_reset(struct upgt_softc *sc) 1923{ 1924 struct upgt_data *data; 1925 char init_cmd[] = { 0x7e, 0x7e, 0x7e, 0x7e }; 1926 1927 UPGT_LOCK(sc); 1928 1929 data = upgt_getbuf(sc); 1930 if (data == NULL) { 1931 UPGT_UNLOCK(sc); 1932 return (ENOBUFS); 1933 } 1934 memcpy(data->buf, init_cmd, sizeof(init_cmd)); 1935 data->buflen = sizeof(init_cmd); 1936 upgt_bulk_tx(sc, data); 1937 usb_pause_mtx(&sc->sc_mtx, 100); 1938 1939 UPGT_UNLOCK(sc); 1940 DPRINTF(sc, UPGT_DEBUG_FW, "%s: device initialized\n", __func__); 1941 return (0); 1942} 1943 1944static int 1945upgt_alloc_tx(struct upgt_softc *sc) 1946{ 1947 int i; 1948 1949 STAILQ_INIT(&sc->sc_tx_active); 1950 STAILQ_INIT(&sc->sc_tx_inactive); 1951 STAILQ_INIT(&sc->sc_tx_pending); 1952 1953 for (i = 0; i < UPGT_TX_MAXCOUNT; i++) { 1954 struct upgt_data *data = &sc->sc_tx_data[i];
| 283 ifp = sc->sc_ifp = if_alloc(IFT_IEEE80211); 284 if (ifp == NULL) { 285 device_printf(dev, "can not if_alloc()\n"); 286 goto fail4; 287 } 288 289 /* Initialize the device. */ 290 error = upgt_device_reset(sc); 291 if (error) 292 goto fail5; 293 /* Verify the firmware. */ 294 error = upgt_fw_verify(sc); 295 if (error) 296 goto fail5; 297 /* Calculate device memory space. */ 298 if (sc->sc_memaddr_frame_start == 0 || sc->sc_memaddr_frame_end == 0) { 299 device_printf(dev, 300 "could not find memory space addresses on FW\n"); 301 error = EIO; 302 goto fail5; 303 } 304 sc->sc_memaddr_frame_end -= UPGT_MEMSIZE_RX + 1; 305 sc->sc_memaddr_rx_start = sc->sc_memaddr_frame_end + 1; 306 307 DPRINTF(sc, UPGT_DEBUG_FW, "memory address frame start=0x%08x\n", 308 sc->sc_memaddr_frame_start); 309 DPRINTF(sc, UPGT_DEBUG_FW, "memory address frame end=0x%08x\n", 310 sc->sc_memaddr_frame_end); 311 DPRINTF(sc, UPGT_DEBUG_FW, "memory address rx start=0x%08x\n", 312 sc->sc_memaddr_rx_start); 313 314 upgt_mem_init(sc); 315 316 /* Load the firmware. */ 317 error = upgt_fw_load(sc); 318 if (error) 319 goto fail5; 320 321 /* Read the whole EEPROM content and parse it. */ 322 error = upgt_eeprom_read(sc); 323 if (error) 324 goto fail5; 325 error = upgt_eeprom_parse(sc); 326 if (error) 327 goto fail5; 328 329 /* all works related with the device have done here. */ 330 upgt_abort_xfers(sc); 331 332 /* Setup the 802.11 device. */ 333 ifp->if_softc = sc; 334 if_initname(ifp, "upgt", device_get_unit(sc->sc_dev)); 335 ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST; 336 ifp->if_init = upgt_init; 337 ifp->if_ioctl = upgt_ioctl; 338 ifp->if_start = upgt_start; 339 IFQ_SET_MAXLEN(&ifp->if_snd, ifqmaxlen); 340 IFQ_SET_READY(&ifp->if_snd); 341 342 ic = ifp->if_l2com; 343 ic->ic_ifp = ifp; 344 ic->ic_phytype = IEEE80211_T_OFDM; /* not only, but not used */ 345 ic->ic_opmode = IEEE80211_M_STA; 346 /* set device capabilities */ 347 ic->ic_caps = 348 IEEE80211_C_STA /* station mode */ 349 | IEEE80211_C_MONITOR /* monitor mode */ 350 | IEEE80211_C_SHPREAMBLE /* short preamble supported */ 351 | IEEE80211_C_SHSLOT /* short slot time supported */ 352 | IEEE80211_C_BGSCAN /* capable of bg scanning */ 353 | IEEE80211_C_WPA /* 802.11i */ 354 ; 355 356 bands = 0; 357 setbit(&bands, IEEE80211_MODE_11B); 358 setbit(&bands, IEEE80211_MODE_11G); 359 ieee80211_init_channels(ic, NULL, &bands); 360 361 ieee80211_ifattach(ic, sc->sc_myaddr); 362 ic->ic_raw_xmit = upgt_raw_xmit; 363 ic->ic_scan_start = upgt_scan_start; 364 ic->ic_scan_end = upgt_scan_end; 365 ic->ic_set_channel = upgt_set_channel; 366 367 ic->ic_vap_create = upgt_vap_create; 368 ic->ic_vap_delete = upgt_vap_delete; 369 ic->ic_update_mcast = upgt_update_mcast; 370 371 ieee80211_radiotap_attach(ic, 372 &sc->sc_txtap.wt_ihdr, sizeof(sc->sc_txtap), 373 UPGT_TX_RADIOTAP_PRESENT, 374 &sc->sc_rxtap.wr_ihdr, sizeof(sc->sc_rxtap), 375 UPGT_RX_RADIOTAP_PRESENT); 376 377 upgt_sysctl_node(sc); 378 379 if (bootverbose) 380 ieee80211_announce(ic); 381 382 return (0); 383 384fail5: if_free(ifp); 385fail4: usbd_transfer_unsetup(sc->sc_xfer, UPGT_N_XFERS); 386fail3: upgt_free_rx(sc); 387fail2: upgt_free_tx(sc); 388fail1: mtx_destroy(&sc->sc_mtx); 389 390 return (error); 391} 392 393static void 394upgt_txeof(struct usb_xfer *xfer, struct upgt_data *data) 395{ 396 struct upgt_softc *sc = usbd_xfer_softc(xfer); 397 struct ifnet *ifp = sc->sc_ifp; 398 struct mbuf *m; 399 400 UPGT_ASSERT_LOCKED(sc); 401 402 /* 403 * Do any tx complete callback. Note this must be done before releasing 404 * the node reference. 405 */ 406 if (data->m) { 407 m = data->m; 408 if (m->m_flags & M_TXCB) { 409 /* XXX status? */ 410 ieee80211_process_callback(data->ni, m, 0); 411 } 412 m_freem(m); 413 data->m = NULL; 414 } 415 if (data->ni) { 416 ieee80211_free_node(data->ni); 417 data->ni = NULL; 418 } 419 ifp->if_opackets++; 420} 421 422static void 423upgt_get_stats(struct upgt_softc *sc) 424{ 425 struct upgt_data *data_cmd; 426 struct upgt_lmac_mem *mem; 427 struct upgt_lmac_stats *stats; 428 429 data_cmd = upgt_getbuf(sc); 430 if (data_cmd == NULL) { 431 device_printf(sc->sc_dev, "%s: out of buffer.\n", __func__); 432 return; 433 } 434 435 /* 436 * Transmit the URB containing the CMD data. 437 */ 438 memset(data_cmd->buf, 0, MCLBYTES); 439 440 mem = (struct upgt_lmac_mem *)data_cmd->buf; 441 mem->addr = htole32(sc->sc_memaddr_frame_start + 442 UPGT_MEMSIZE_FRAME_HEAD); 443 444 stats = (struct upgt_lmac_stats *)(mem + 1); 445 446 stats->header1.flags = 0; 447 stats->header1.type = UPGT_H1_TYPE_CTRL; 448 stats->header1.len = htole16( 449 sizeof(struct upgt_lmac_stats) - sizeof(struct upgt_lmac_header)); 450 451 stats->header2.reqid = htole32(sc->sc_memaddr_frame_start); 452 stats->header2.type = htole16(UPGT_H2_TYPE_STATS); 453 stats->header2.flags = 0; 454 455 data_cmd->buflen = sizeof(*mem) + sizeof(*stats); 456 457 mem->chksum = upgt_chksum_le((uint32_t *)stats, 458 data_cmd->buflen - sizeof(*mem)); 459 460 upgt_bulk_tx(sc, data_cmd); 461} 462 463static int 464upgt_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data) 465{ 466 struct upgt_softc *sc = ifp->if_softc; 467 struct ieee80211com *ic = ifp->if_l2com; 468 struct ifreq *ifr = (struct ifreq *) data; 469 int error = 0, startall = 0; 470 471 switch (cmd) { 472 case SIOCSIFFLAGS: 473 if (ifp->if_flags & IFF_UP) { 474 if (ifp->if_drv_flags & IFF_DRV_RUNNING) { 475 if ((ifp->if_flags ^ sc->sc_if_flags) & 476 (IFF_ALLMULTI | IFF_PROMISC)) 477 upgt_set_multi(sc); 478 } else { 479 upgt_init(sc); 480 startall = 1; 481 } 482 } else { 483 if (ifp->if_drv_flags & IFF_DRV_RUNNING) 484 upgt_stop(sc); 485 } 486 sc->sc_if_flags = ifp->if_flags; 487 if (startall) 488 ieee80211_start_all(ic); 489 break; 490 case SIOCGIFMEDIA: 491 error = ifmedia_ioctl(ifp, ifr, &ic->ic_media, cmd); 492 break; 493 case SIOCGIFADDR: 494 error = ether_ioctl(ifp, cmd, data); 495 break; 496 default: 497 error = EINVAL; 498 break; 499 } 500 return error; 501} 502 503static void 504upgt_stop_locked(struct upgt_softc *sc) 505{ 506 struct ifnet *ifp = sc->sc_ifp; 507 508 UPGT_ASSERT_LOCKED(sc); 509 510 if (ifp->if_drv_flags & IFF_DRV_RUNNING) 511 upgt_set_macfilter(sc, IEEE80211_S_INIT); 512 upgt_abort_xfers_locked(sc); 513} 514 515static void 516upgt_stop(struct upgt_softc *sc) 517{ 518 struct ifnet *ifp = sc->sc_ifp; 519 520 UPGT_LOCK(sc); 521 upgt_stop_locked(sc); 522 UPGT_UNLOCK(sc); 523 524 /* device down */ 525 sc->sc_tx_timer = 0; 526 ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE); 527 sc->sc_flags &= ~UPGT_FLAG_INITDONE; 528} 529 530static void 531upgt_set_led(struct upgt_softc *sc, int action) 532{ 533 struct upgt_data *data_cmd; 534 struct upgt_lmac_mem *mem; 535 struct upgt_lmac_led *led; 536 537 data_cmd = upgt_getbuf(sc); 538 if (data_cmd == NULL) { 539 device_printf(sc->sc_dev, "%s: out of buffers.\n", __func__); 540 return; 541 } 542 543 /* 544 * Transmit the URB containing the CMD data. 545 */ 546 memset(data_cmd->buf, 0, MCLBYTES); 547 548 mem = (struct upgt_lmac_mem *)data_cmd->buf; 549 mem->addr = htole32(sc->sc_memaddr_frame_start + 550 UPGT_MEMSIZE_FRAME_HEAD); 551 552 led = (struct upgt_lmac_led *)(mem + 1); 553 554 led->header1.flags = UPGT_H1_FLAGS_TX_NO_CALLBACK; 555 led->header1.type = UPGT_H1_TYPE_CTRL; 556 led->header1.len = htole16( 557 sizeof(struct upgt_lmac_led) - 558 sizeof(struct upgt_lmac_header)); 559 560 led->header2.reqid = htole32(sc->sc_memaddr_frame_start); 561 led->header2.type = htole16(UPGT_H2_TYPE_LED); 562 led->header2.flags = 0; 563 564 switch (action) { 565 case UPGT_LED_OFF: 566 led->mode = htole16(UPGT_LED_MODE_SET); 567 led->action_fix = 0; 568 led->action_tmp = htole16(UPGT_LED_ACTION_OFF); 569 led->action_tmp_dur = 0; 570 break; 571 case UPGT_LED_ON: 572 led->mode = htole16(UPGT_LED_MODE_SET); 573 led->action_fix = 0; 574 led->action_tmp = htole16(UPGT_LED_ACTION_ON); 575 led->action_tmp_dur = 0; 576 break; 577 case UPGT_LED_BLINK: 578 if (sc->sc_state != IEEE80211_S_RUN) { 579 STAILQ_INSERT_TAIL(&sc->sc_tx_inactive, data_cmd, next); 580 return; 581 } 582 if (sc->sc_led_blink) { 583 /* previous blink was not finished */ 584 STAILQ_INSERT_TAIL(&sc->sc_tx_inactive, data_cmd, next); 585 return; 586 } 587 led->mode = htole16(UPGT_LED_MODE_SET); 588 led->action_fix = htole16(UPGT_LED_ACTION_OFF); 589 led->action_tmp = htole16(UPGT_LED_ACTION_ON); 590 led->action_tmp_dur = htole16(UPGT_LED_ACTION_TMP_DUR); 591 /* lock blink */ 592 sc->sc_led_blink = 1; 593 callout_reset(&sc->sc_led_ch, hz, upgt_set_led_blink, sc); 594 break; 595 default: 596 STAILQ_INSERT_TAIL(&sc->sc_tx_inactive, data_cmd, next); 597 return; 598 } 599 600 data_cmd->buflen = sizeof(*mem) + sizeof(*led); 601 602 mem->chksum = upgt_chksum_le((uint32_t *)led, 603 data_cmd->buflen - sizeof(*mem)); 604 605 upgt_bulk_tx(sc, data_cmd); 606} 607 608static void 609upgt_set_led_blink(void *arg) 610{ 611 struct upgt_softc *sc = arg; 612 613 /* blink finished, we are ready for a next one */ 614 sc->sc_led_blink = 0; 615} 616 617static void 618upgt_init(void *priv) 619{ 620 struct upgt_softc *sc = priv; 621 struct ifnet *ifp = sc->sc_ifp; 622 struct ieee80211com *ic = ifp->if_l2com; 623 624 UPGT_LOCK(sc); 625 upgt_init_locked(sc); 626 UPGT_UNLOCK(sc); 627 628 if (ifp->if_drv_flags & IFF_DRV_RUNNING) 629 ieee80211_start_all(ic); /* start all vap's */ 630} 631 632static void 633upgt_init_locked(struct upgt_softc *sc) 634{ 635 struct ifnet *ifp = sc->sc_ifp; 636 637 UPGT_ASSERT_LOCKED(sc); 638 639 if (ifp->if_drv_flags & IFF_DRV_RUNNING) 640 upgt_stop_locked(sc); 641 642 usbd_transfer_start(sc->sc_xfer[UPGT_BULK_RX]); 643 644 (void)upgt_set_macfilter(sc, IEEE80211_S_SCAN); 645 646 ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 647 ifp->if_drv_flags |= IFF_DRV_RUNNING; 648 sc->sc_flags |= UPGT_FLAG_INITDONE; 649 650 callout_reset(&sc->sc_watchdog_ch, hz, upgt_watchdog, sc); 651} 652 653static int 654upgt_set_macfilter(struct upgt_softc *sc, uint8_t state) 655{ 656 struct ifnet *ifp = sc->sc_ifp; 657 struct ieee80211com *ic = ifp->if_l2com; 658 struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps); 659 struct ieee80211_node *ni; 660 struct upgt_data *data_cmd; 661 struct upgt_lmac_mem *mem; 662 struct upgt_lmac_filter *filter; 663 uint8_t broadcast[] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; 664 665 UPGT_ASSERT_LOCKED(sc); 666 667 data_cmd = upgt_getbuf(sc); 668 if (data_cmd == NULL) { 669 device_printf(sc->sc_dev, "out of TX buffers.\n"); 670 return (ENOBUFS); 671 } 672 673 /* 674 * Transmit the URB containing the CMD data. 675 */ 676 memset(data_cmd->buf, 0, MCLBYTES); 677 678 mem = (struct upgt_lmac_mem *)data_cmd->buf; 679 mem->addr = htole32(sc->sc_memaddr_frame_start + 680 UPGT_MEMSIZE_FRAME_HEAD); 681 682 filter = (struct upgt_lmac_filter *)(mem + 1); 683 684 filter->header1.flags = UPGT_H1_FLAGS_TX_NO_CALLBACK; 685 filter->header1.type = UPGT_H1_TYPE_CTRL; 686 filter->header1.len = htole16( 687 sizeof(struct upgt_lmac_filter) - 688 sizeof(struct upgt_lmac_header)); 689 690 filter->header2.reqid = htole32(sc->sc_memaddr_frame_start); 691 filter->header2.type = htole16(UPGT_H2_TYPE_MACFILTER); 692 filter->header2.flags = 0; 693 694 switch (state) { 695 case IEEE80211_S_INIT: 696 DPRINTF(sc, UPGT_DEBUG_STATE, "%s: set MAC filter to INIT\n", 697 __func__); 698 filter->type = htole16(UPGT_FILTER_TYPE_RESET); 699 break; 700 case IEEE80211_S_SCAN: 701 DPRINTF(sc, UPGT_DEBUG_STATE, 702 "set MAC filter to SCAN (bssid %s)\n", 703 ether_sprintf(broadcast)); 704 filter->type = htole16(UPGT_FILTER_TYPE_NONE); 705 IEEE80211_ADDR_COPY(filter->dst, sc->sc_myaddr); 706 IEEE80211_ADDR_COPY(filter->src, broadcast); 707 filter->unknown1 = htole16(UPGT_FILTER_UNKNOWN1); 708 filter->rxaddr = htole32(sc->sc_memaddr_rx_start); 709 filter->unknown2 = htole16(UPGT_FILTER_UNKNOWN2); 710 filter->rxhw = htole32(sc->sc_eeprom_hwrx); 711 filter->unknown3 = htole16(UPGT_FILTER_UNKNOWN3); 712 break; 713 case IEEE80211_S_RUN: 714 ni = ieee80211_ref_node(vap->iv_bss); 715 /* XXX monitor mode isn't tested yet. */ 716 if (vap->iv_opmode == IEEE80211_M_MONITOR) { 717 filter->type = htole16(UPGT_FILTER_TYPE_MONITOR); 718 IEEE80211_ADDR_COPY(filter->dst, sc->sc_myaddr); 719 IEEE80211_ADDR_COPY(filter->src, ni->ni_bssid); 720 filter->unknown1 = htole16(UPGT_FILTER_MONITOR_UNKNOWN1); 721 filter->rxaddr = htole32(sc->sc_memaddr_rx_start); 722 filter->unknown2 = htole16(UPGT_FILTER_MONITOR_UNKNOWN2); 723 filter->rxhw = htole32(sc->sc_eeprom_hwrx); 724 filter->unknown3 = htole16(UPGT_FILTER_MONITOR_UNKNOWN3); 725 } else { 726 DPRINTF(sc, UPGT_DEBUG_STATE, 727 "set MAC filter to RUN (bssid %s)\n", 728 ether_sprintf(ni->ni_bssid)); 729 filter->type = htole16(UPGT_FILTER_TYPE_STA); 730 IEEE80211_ADDR_COPY(filter->dst, sc->sc_myaddr); 731 IEEE80211_ADDR_COPY(filter->src, ni->ni_bssid); 732 filter->unknown1 = htole16(UPGT_FILTER_UNKNOWN1); 733 filter->rxaddr = htole32(sc->sc_memaddr_rx_start); 734 filter->unknown2 = htole16(UPGT_FILTER_UNKNOWN2); 735 filter->rxhw = htole32(sc->sc_eeprom_hwrx); 736 filter->unknown3 = htole16(UPGT_FILTER_UNKNOWN3); 737 } 738 ieee80211_free_node(ni); 739 break; 740 default: 741 device_printf(sc->sc_dev, 742 "MAC filter does not know that state\n"); 743 break; 744 } 745 746 data_cmd->buflen = sizeof(*mem) + sizeof(*filter); 747 748 mem->chksum = upgt_chksum_le((uint32_t *)filter, 749 data_cmd->buflen - sizeof(*mem)); 750 751 upgt_bulk_tx(sc, data_cmd); 752 753 return (0); 754} 755 756static void 757upgt_setup_rates(struct ieee80211vap *vap, struct ieee80211com *ic) 758{ 759 struct ifnet *ifp = ic->ic_ifp; 760 struct upgt_softc *sc = ifp->if_softc; 761 const struct ieee80211_txparam *tp; 762 763 /* 764 * 0x01 = OFMD6 0x10 = DS1 765 * 0x04 = OFDM9 0x11 = DS2 766 * 0x06 = OFDM12 0x12 = DS5 767 * 0x07 = OFDM18 0x13 = DS11 768 * 0x08 = OFDM24 769 * 0x09 = OFDM36 770 * 0x0a = OFDM48 771 * 0x0b = OFDM54 772 */ 773 const uint8_t rateset_auto_11b[] = 774 { 0x13, 0x13, 0x12, 0x11, 0x11, 0x10, 0x10, 0x10 }; 775 const uint8_t rateset_auto_11g[] = 776 { 0x0b, 0x0a, 0x09, 0x08, 0x07, 0x06, 0x04, 0x01 }; 777 const uint8_t rateset_fix_11bg[] = 778 { 0x10, 0x11, 0x12, 0x13, 0x01, 0x04, 0x06, 0x07, 779 0x08, 0x09, 0x0a, 0x0b }; 780 781 tp = &vap->iv_txparms[ieee80211_chan2mode(ic->ic_curchan)]; 782 783 /* XXX */ 784 if (tp->ucastrate == IEEE80211_FIXED_RATE_NONE) { 785 /* 786 * Automatic rate control is done by the device. 787 * We just pass the rateset from which the device 788 * will pickup a rate. 789 */ 790 if (ic->ic_curmode == IEEE80211_MODE_11B) 791 memcpy(sc->sc_cur_rateset, rateset_auto_11b, 792 sizeof(sc->sc_cur_rateset)); 793 if (ic->ic_curmode == IEEE80211_MODE_11G || 794 ic->ic_curmode == IEEE80211_MODE_AUTO) 795 memcpy(sc->sc_cur_rateset, rateset_auto_11g, 796 sizeof(sc->sc_cur_rateset)); 797 } else { 798 /* set a fixed rate */ 799 memset(sc->sc_cur_rateset, rateset_fix_11bg[tp->ucastrate], 800 sizeof(sc->sc_cur_rateset)); 801 } 802} 803 804static void 805upgt_set_multi(void *arg) 806{ 807 struct upgt_softc *sc = arg; 808 struct ifnet *ifp = sc->sc_ifp; 809 810 if (!(ifp->if_flags & IFF_UP)) 811 return; 812 813 /* 814 * XXX don't know how to set a device. Lack of docs. Just try to set 815 * IFF_ALLMULTI flag here. 816 */ 817 ifp->if_flags |= IFF_ALLMULTI; 818} 819 820static void 821upgt_start(struct ifnet *ifp) 822{ 823 struct upgt_softc *sc = ifp->if_softc; 824 struct upgt_data *data_tx; 825 struct ieee80211_node *ni; 826 struct mbuf *m; 827 828 if ((ifp->if_drv_flags & IFF_DRV_RUNNING) == 0) 829 return; 830 831 UPGT_LOCK(sc); 832 for (;;) { 833 IFQ_DRV_DEQUEUE(&ifp->if_snd, m); 834 if (m == NULL) 835 break; 836 837 data_tx = upgt_gettxbuf(sc); 838 if (data_tx == NULL) { 839 IFQ_DRV_PREPEND(&ifp->if_snd, m); 840 break; 841 } 842 843 ni = (struct ieee80211_node *)m->m_pkthdr.rcvif; 844 m->m_pkthdr.rcvif = NULL; 845 846 if (upgt_tx_start(sc, m, ni, data_tx) != 0) { 847 STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, data_tx, next); 848 UPGT_STAT_INC(sc, st_tx_inactive); 849 ieee80211_free_node(ni); 850 ifp->if_oerrors++; 851 continue; 852 } 853 sc->sc_tx_timer = 5; 854 } 855 UPGT_UNLOCK(sc); 856} 857 858static int 859upgt_raw_xmit(struct ieee80211_node *ni, struct mbuf *m, 860 const struct ieee80211_bpf_params *params) 861{ 862 struct ieee80211com *ic = ni->ni_ic; 863 struct ifnet *ifp = ic->ic_ifp; 864 struct upgt_softc *sc = ifp->if_softc; 865 struct upgt_data *data_tx = NULL; 866 867 /* prevent management frames from being sent if we're not ready */ 868 if (!(ifp->if_drv_flags & IFF_DRV_RUNNING)) { 869 m_freem(m); 870 ieee80211_free_node(ni); 871 return ENETDOWN; 872 } 873 874 UPGT_LOCK(sc); 875 data_tx = upgt_gettxbuf(sc); 876 if (data_tx == NULL) { 877 ieee80211_free_node(ni); 878 m_freem(m); 879 UPGT_UNLOCK(sc); 880 return (ENOBUFS); 881 } 882 883 if (upgt_tx_start(sc, m, ni, data_tx) != 0) { 884 STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, data_tx, next); 885 UPGT_STAT_INC(sc, st_tx_inactive); 886 ieee80211_free_node(ni); 887 ifp->if_oerrors++; 888 UPGT_UNLOCK(sc); 889 return (EIO); 890 } 891 UPGT_UNLOCK(sc); 892 893 sc->sc_tx_timer = 5; 894 return (0); 895} 896 897static void 898upgt_watchdog(void *arg) 899{ 900 struct upgt_softc *sc = arg; 901 struct ifnet *ifp = sc->sc_ifp; 902 903 if (sc->sc_tx_timer > 0) { 904 if (--sc->sc_tx_timer == 0) { 905 device_printf(sc->sc_dev, "watchdog timeout\n"); 906 /* upgt_init(ifp); XXX needs a process context ? */ 907 ifp->if_oerrors++; 908 return; 909 } 910 callout_reset(&sc->sc_watchdog_ch, hz, upgt_watchdog, sc); 911 } 912} 913 914static uint32_t 915upgt_mem_alloc(struct upgt_softc *sc) 916{ 917 int i; 918 919 for (i = 0; i < sc->sc_memory.pages; i++) { 920 if (sc->sc_memory.page[i].used == 0) { 921 sc->sc_memory.page[i].used = 1; 922 return (sc->sc_memory.page[i].addr); 923 } 924 } 925 926 return (0); 927} 928 929static void 930upgt_scan_start(struct ieee80211com *ic) 931{ 932 /* do nothing. */ 933} 934 935static void 936upgt_scan_end(struct ieee80211com *ic) 937{ 938 /* do nothing. */ 939} 940 941static void 942upgt_set_channel(struct ieee80211com *ic) 943{ 944 struct upgt_softc *sc = ic->ic_ifp->if_softc; 945 946 UPGT_LOCK(sc); 947 upgt_set_chan(sc, ic->ic_curchan); 948 UPGT_UNLOCK(sc); 949} 950 951static void 952upgt_set_chan(struct upgt_softc *sc, struct ieee80211_channel *c) 953{ 954 struct ifnet *ifp = sc->sc_ifp; 955 struct ieee80211com *ic = ifp->if_l2com; 956 struct upgt_data *data_cmd; 957 struct upgt_lmac_mem *mem; 958 struct upgt_lmac_channel *chan; 959 int channel; 960 961 UPGT_ASSERT_LOCKED(sc); 962 963 channel = ieee80211_chan2ieee(ic, c); 964 if (channel == 0 || channel == IEEE80211_CHAN_ANY) { 965 /* XXX should NEVER happen */ 966 device_printf(sc->sc_dev, 967 "%s: invalid channel %x\n", __func__, channel); 968 return; 969 } 970 971 DPRINTF(sc, UPGT_DEBUG_STATE, "%s: channel %d\n", __func__, channel); 972 973 data_cmd = upgt_getbuf(sc); 974 if (data_cmd == NULL) { 975 device_printf(sc->sc_dev, "%s: out of buffers.\n", __func__); 976 return; 977 } 978 /* 979 * Transmit the URB containing the CMD data. 980 */ 981 memset(data_cmd->buf, 0, MCLBYTES); 982 983 mem = (struct upgt_lmac_mem *)data_cmd->buf; 984 mem->addr = htole32(sc->sc_memaddr_frame_start + 985 UPGT_MEMSIZE_FRAME_HEAD); 986 987 chan = (struct upgt_lmac_channel *)(mem + 1); 988 989 chan->header1.flags = UPGT_H1_FLAGS_TX_NO_CALLBACK; 990 chan->header1.type = UPGT_H1_TYPE_CTRL; 991 chan->header1.len = htole16( 992 sizeof(struct upgt_lmac_channel) - sizeof(struct upgt_lmac_header)); 993 994 chan->header2.reqid = htole32(sc->sc_memaddr_frame_start); 995 chan->header2.type = htole16(UPGT_H2_TYPE_CHANNEL); 996 chan->header2.flags = 0; 997 998 chan->unknown1 = htole16(UPGT_CHANNEL_UNKNOWN1); 999 chan->unknown2 = htole16(UPGT_CHANNEL_UNKNOWN2); 1000 chan->freq6 = sc->sc_eeprom_freq6[channel]; 1001 chan->settings = sc->sc_eeprom_freq6_settings; 1002 chan->unknown3 = UPGT_CHANNEL_UNKNOWN3; 1003 1004 memcpy(chan->freq3_1, &sc->sc_eeprom_freq3[channel].data, 1005 sizeof(chan->freq3_1)); 1006 memcpy(chan->freq4, &sc->sc_eeprom_freq4[channel], 1007 sizeof(sc->sc_eeprom_freq4[channel])); 1008 memcpy(chan->freq3_2, &sc->sc_eeprom_freq3[channel].data, 1009 sizeof(chan->freq3_2)); 1010 1011 data_cmd->buflen = sizeof(*mem) + sizeof(*chan); 1012 1013 mem->chksum = upgt_chksum_le((uint32_t *)chan, 1014 data_cmd->buflen - sizeof(*mem)); 1015 1016 upgt_bulk_tx(sc, data_cmd); 1017} 1018 1019static struct ieee80211vap * 1020upgt_vap_create(struct ieee80211com *ic, const char name[IFNAMSIZ], int unit, 1021 enum ieee80211_opmode opmode, int flags, 1022 const uint8_t bssid[IEEE80211_ADDR_LEN], 1023 const uint8_t mac[IEEE80211_ADDR_LEN]) 1024{ 1025 struct upgt_vap *uvp; 1026 struct ieee80211vap *vap; 1027 1028 if (!TAILQ_EMPTY(&ic->ic_vaps)) /* only one at a time */ 1029 return NULL; 1030 uvp = (struct upgt_vap *) malloc(sizeof(struct upgt_vap), 1031 M_80211_VAP, M_NOWAIT | M_ZERO); 1032 if (uvp == NULL) 1033 return NULL; 1034 vap = &uvp->vap; 1035 /* enable s/w bmiss handling for sta mode */ 1036 ieee80211_vap_setup(ic, vap, name, unit, opmode, 1037 flags | IEEE80211_CLONE_NOBEACONS, bssid, mac); 1038 1039 /* override state transition machine */ 1040 uvp->newstate = vap->iv_newstate; 1041 vap->iv_newstate = upgt_newstate; 1042 1043 /* setup device rates */ 1044 upgt_setup_rates(vap, ic); 1045 1046 /* complete setup */ 1047 ieee80211_vap_attach(vap, ieee80211_media_change, 1048 ieee80211_media_status); 1049 ic->ic_opmode = opmode; 1050 return vap; 1051} 1052 1053static int 1054upgt_newstate(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 1055{ 1056 struct upgt_vap *uvp = UPGT_VAP(vap); 1057 struct ieee80211com *ic = vap->iv_ic; 1058 struct upgt_softc *sc = ic->ic_ifp->if_softc; 1059 1060 /* do it in a process context */ 1061 sc->sc_state = nstate; 1062 1063 IEEE80211_UNLOCK(ic); 1064 UPGT_LOCK(sc); 1065 callout_stop(&sc->sc_led_ch); 1066 callout_stop(&sc->sc_watchdog_ch); 1067 1068 switch (nstate) { 1069 case IEEE80211_S_INIT: 1070 /* do not accept any frames if the device is down */ 1071 (void)upgt_set_macfilter(sc, sc->sc_state); 1072 upgt_set_led(sc, UPGT_LED_OFF); 1073 break; 1074 case IEEE80211_S_SCAN: 1075 upgt_set_chan(sc, ic->ic_curchan); 1076 break; 1077 case IEEE80211_S_AUTH: 1078 upgt_set_chan(sc, ic->ic_curchan); 1079 break; 1080 case IEEE80211_S_ASSOC: 1081 break; 1082 case IEEE80211_S_RUN: 1083 upgt_set_macfilter(sc, sc->sc_state); 1084 upgt_set_led(sc, UPGT_LED_ON); 1085 break; 1086 default: 1087 break; 1088 } 1089 UPGT_UNLOCK(sc); 1090 IEEE80211_LOCK(ic); 1091 return (uvp->newstate(vap, nstate, arg)); 1092} 1093 1094static void 1095upgt_vap_delete(struct ieee80211vap *vap) 1096{ 1097 struct upgt_vap *uvp = UPGT_VAP(vap); 1098 1099 ieee80211_vap_detach(vap); 1100 free(uvp, M_80211_VAP); 1101} 1102 1103static void 1104upgt_update_mcast(struct ifnet *ifp) 1105{ 1106 struct upgt_softc *sc = ifp->if_softc; 1107 1108 upgt_set_multi(sc); 1109} 1110 1111static int 1112upgt_eeprom_parse(struct upgt_softc *sc) 1113{ 1114 struct upgt_eeprom_header *eeprom_header; 1115 struct upgt_eeprom_option *eeprom_option; 1116 uint16_t option_len; 1117 uint16_t option_type; 1118 uint16_t preamble_len; 1119 int option_end = 0; 1120 1121 /* calculate eeprom options start offset */ 1122 eeprom_header = (struct upgt_eeprom_header *)sc->sc_eeprom; 1123 preamble_len = le16toh(eeprom_header->preamble_len); 1124 eeprom_option = (struct upgt_eeprom_option *)(sc->sc_eeprom + 1125 (sizeof(struct upgt_eeprom_header) + preamble_len)); 1126 1127 while (!option_end) { 1128 /* the eeprom option length is stored in words */ 1129 option_len = 1130 (le16toh(eeprom_option->len) - 1) * sizeof(uint16_t); 1131 option_type = 1132 le16toh(eeprom_option->type); 1133 1134 switch (option_type) { 1135 case UPGT_EEPROM_TYPE_NAME: 1136 DPRINTF(sc, UPGT_DEBUG_FW, 1137 "EEPROM name len=%d\n", option_len); 1138 break; 1139 case UPGT_EEPROM_TYPE_SERIAL: 1140 DPRINTF(sc, UPGT_DEBUG_FW, 1141 "EEPROM serial len=%d\n", option_len); 1142 break; 1143 case UPGT_EEPROM_TYPE_MAC: 1144 DPRINTF(sc, UPGT_DEBUG_FW, 1145 "EEPROM mac len=%d\n", option_len); 1146 1147 IEEE80211_ADDR_COPY(sc->sc_myaddr, eeprom_option->data); 1148 break; 1149 case UPGT_EEPROM_TYPE_HWRX: 1150 DPRINTF(sc, UPGT_DEBUG_FW, 1151 "EEPROM hwrx len=%d\n", option_len); 1152 1153 upgt_eeprom_parse_hwrx(sc, eeprom_option->data); 1154 break; 1155 case UPGT_EEPROM_TYPE_CHIP: 1156 DPRINTF(sc, UPGT_DEBUG_FW, 1157 "EEPROM chip len=%d\n", option_len); 1158 break; 1159 case UPGT_EEPROM_TYPE_FREQ3: 1160 DPRINTF(sc, UPGT_DEBUG_FW, 1161 "EEPROM freq3 len=%d\n", option_len); 1162 1163 upgt_eeprom_parse_freq3(sc, eeprom_option->data, 1164 option_len); 1165 break; 1166 case UPGT_EEPROM_TYPE_FREQ4: 1167 DPRINTF(sc, UPGT_DEBUG_FW, 1168 "EEPROM freq4 len=%d\n", option_len); 1169 1170 upgt_eeprom_parse_freq4(sc, eeprom_option->data, 1171 option_len); 1172 break; 1173 case UPGT_EEPROM_TYPE_FREQ5: 1174 DPRINTF(sc, UPGT_DEBUG_FW, 1175 "EEPROM freq5 len=%d\n", option_len); 1176 break; 1177 case UPGT_EEPROM_TYPE_FREQ6: 1178 DPRINTF(sc, UPGT_DEBUG_FW, 1179 "EEPROM freq6 len=%d\n", option_len); 1180 1181 upgt_eeprom_parse_freq6(sc, eeprom_option->data, 1182 option_len); 1183 break; 1184 case UPGT_EEPROM_TYPE_END: 1185 DPRINTF(sc, UPGT_DEBUG_FW, 1186 "EEPROM end len=%d\n", option_len); 1187 option_end = 1; 1188 break; 1189 case UPGT_EEPROM_TYPE_OFF: 1190 DPRINTF(sc, UPGT_DEBUG_FW, 1191 "%s: EEPROM off without end option\n", __func__); 1192 return (EIO); 1193 default: 1194 DPRINTF(sc, UPGT_DEBUG_FW, 1195 "EEPROM unknown type 0x%04x len=%d\n", 1196 option_type, option_len); 1197 break; 1198 } 1199 1200 /* jump to next EEPROM option */ 1201 eeprom_option = (struct upgt_eeprom_option *) 1202 (eeprom_option->data + option_len); 1203 } 1204 1205 return (0); 1206} 1207 1208static void 1209upgt_eeprom_parse_freq3(struct upgt_softc *sc, uint8_t *data, int len) 1210{ 1211 struct upgt_eeprom_freq3_header *freq3_header; 1212 struct upgt_lmac_freq3 *freq3; 1213 int i, elements, flags; 1214 unsigned channel; 1215 1216 freq3_header = (struct upgt_eeprom_freq3_header *)data; 1217 freq3 = (struct upgt_lmac_freq3 *)(freq3_header + 1); 1218 1219 flags = freq3_header->flags; 1220 elements = freq3_header->elements; 1221 1222 DPRINTF(sc, UPGT_DEBUG_FW, "flags=0x%02x elements=%d\n", 1223 flags, elements); 1224 1225 for (i = 0; i < elements; i++) { 1226 channel = ieee80211_mhz2ieee(le16toh(freq3[i].freq), 0); 1227 if (channel >= IEEE80211_CHAN_MAX) 1228 continue; 1229 1230 sc->sc_eeprom_freq3[channel] = freq3[i]; 1231 1232 DPRINTF(sc, UPGT_DEBUG_FW, "frequence=%d, channel=%d\n", 1233 le16toh(sc->sc_eeprom_freq3[channel].freq), channel); 1234 } 1235} 1236 1237void 1238upgt_eeprom_parse_freq4(struct upgt_softc *sc, uint8_t *data, int len) 1239{ 1240 struct upgt_eeprom_freq4_header *freq4_header; 1241 struct upgt_eeprom_freq4_1 *freq4_1; 1242 struct upgt_eeprom_freq4_2 *freq4_2; 1243 int i, j, elements, settings, flags; 1244 unsigned channel; 1245 1246 freq4_header = (struct upgt_eeprom_freq4_header *)data; 1247 freq4_1 = (struct upgt_eeprom_freq4_1 *)(freq4_header + 1); 1248 flags = freq4_header->flags; 1249 elements = freq4_header->elements; 1250 settings = freq4_header->settings; 1251 1252 /* we need this value later */ 1253 sc->sc_eeprom_freq6_settings = freq4_header->settings; 1254 1255 DPRINTF(sc, UPGT_DEBUG_FW, "flags=0x%02x elements=%d settings=%d\n", 1256 flags, elements, settings); 1257 1258 for (i = 0; i < elements; i++) { 1259 channel = ieee80211_mhz2ieee(le16toh(freq4_1[i].freq), 0); 1260 if (channel >= IEEE80211_CHAN_MAX) 1261 continue; 1262 1263 freq4_2 = (struct upgt_eeprom_freq4_2 *)freq4_1[i].data; 1264 for (j = 0; j < settings; j++) { 1265 sc->sc_eeprom_freq4[channel][j].cmd = freq4_2[j]; 1266 sc->sc_eeprom_freq4[channel][j].pad = 0; 1267 } 1268 1269 DPRINTF(sc, UPGT_DEBUG_FW, "frequence=%d, channel=%d\n", 1270 le16toh(freq4_1[i].freq), channel); 1271 } 1272} 1273 1274void 1275upgt_eeprom_parse_freq6(struct upgt_softc *sc, uint8_t *data, int len) 1276{ 1277 struct upgt_lmac_freq6 *freq6; 1278 int i, elements; 1279 unsigned channel; 1280 1281 freq6 = (struct upgt_lmac_freq6 *)data; 1282 elements = len / sizeof(struct upgt_lmac_freq6); 1283 1284 DPRINTF(sc, UPGT_DEBUG_FW, "elements=%d\n", elements); 1285 1286 for (i = 0; i < elements; i++) { 1287 channel = ieee80211_mhz2ieee(le16toh(freq6[i].freq), 0); 1288 if (channel >= IEEE80211_CHAN_MAX) 1289 continue; 1290 1291 sc->sc_eeprom_freq6[channel] = freq6[i]; 1292 1293 DPRINTF(sc, UPGT_DEBUG_FW, "frequence=%d, channel=%d\n", 1294 le16toh(sc->sc_eeprom_freq6[channel].freq), channel); 1295 } 1296} 1297 1298static void 1299upgt_eeprom_parse_hwrx(struct upgt_softc *sc, uint8_t *data) 1300{ 1301 struct upgt_eeprom_option_hwrx *option_hwrx; 1302 1303 option_hwrx = (struct upgt_eeprom_option_hwrx *)data; 1304 1305 sc->sc_eeprom_hwrx = option_hwrx->rxfilter - UPGT_EEPROM_RX_CONST; 1306 1307 DPRINTF(sc, UPGT_DEBUG_FW, "hwrx option value=0x%04x\n", 1308 sc->sc_eeprom_hwrx); 1309} 1310 1311static int 1312upgt_eeprom_read(struct upgt_softc *sc) 1313{ 1314 struct upgt_data *data_cmd; 1315 struct upgt_lmac_mem *mem; 1316 struct upgt_lmac_eeprom *eeprom; 1317 int block, error, offset; 1318 1319 UPGT_LOCK(sc); 1320 usb_pause_mtx(&sc->sc_mtx, 100); 1321 1322 offset = 0; 1323 block = UPGT_EEPROM_BLOCK_SIZE; 1324 while (offset < UPGT_EEPROM_SIZE) { 1325 DPRINTF(sc, UPGT_DEBUG_FW, 1326 "request EEPROM block (offset=%d, len=%d)\n", offset, block); 1327 1328 data_cmd = upgt_getbuf(sc); 1329 if (data_cmd == NULL) { 1330 UPGT_UNLOCK(sc); 1331 return (ENOBUFS); 1332 } 1333 1334 /* 1335 * Transmit the URB containing the CMD data. 1336 */ 1337 memset(data_cmd->buf, 0, MCLBYTES); 1338 1339 mem = (struct upgt_lmac_mem *)data_cmd->buf; 1340 mem->addr = htole32(sc->sc_memaddr_frame_start + 1341 UPGT_MEMSIZE_FRAME_HEAD); 1342 1343 eeprom = (struct upgt_lmac_eeprom *)(mem + 1); 1344 eeprom->header1.flags = 0; 1345 eeprom->header1.type = UPGT_H1_TYPE_CTRL; 1346 eeprom->header1.len = htole16(( 1347 sizeof(struct upgt_lmac_eeprom) - 1348 sizeof(struct upgt_lmac_header)) + block); 1349 1350 eeprom->header2.reqid = htole32(sc->sc_memaddr_frame_start); 1351 eeprom->header2.type = htole16(UPGT_H2_TYPE_EEPROM); 1352 eeprom->header2.flags = 0; 1353 1354 eeprom->offset = htole16(offset); 1355 eeprom->len = htole16(block); 1356 1357 data_cmd->buflen = sizeof(*mem) + sizeof(*eeprom) + block; 1358 1359 mem->chksum = upgt_chksum_le((uint32_t *)eeprom, 1360 data_cmd->buflen - sizeof(*mem)); 1361 upgt_bulk_tx(sc, data_cmd); 1362 1363 error = mtx_sleep(sc, &sc->sc_mtx, 0, "eeprom_request", hz); 1364 if (error != 0) { 1365 device_printf(sc->sc_dev, 1366 "timeout while waiting for EEPROM data\n"); 1367 UPGT_UNLOCK(sc); 1368 return (EIO); 1369 } 1370 1371 offset += block; 1372 if (UPGT_EEPROM_SIZE - offset < block) 1373 block = UPGT_EEPROM_SIZE - offset; 1374 } 1375 1376 UPGT_UNLOCK(sc); 1377 return (0); 1378} 1379 1380/* 1381 * When a rx data came in the function returns a mbuf and a rssi values. 1382 */ 1383static struct mbuf * 1384upgt_rxeof(struct usb_xfer *xfer, struct upgt_data *data, int *rssi) 1385{ 1386 struct mbuf *m = NULL; 1387 struct upgt_softc *sc = usbd_xfer_softc(xfer); 1388 struct upgt_lmac_header *header; 1389 struct upgt_lmac_eeprom *eeprom; 1390 uint8_t h1_type; 1391 uint16_t h2_type; 1392 int actlen, sumlen; 1393 1394 usbd_xfer_status(xfer, &actlen, &sumlen, NULL, NULL); 1395 1396 UPGT_ASSERT_LOCKED(sc); 1397 1398 if (actlen < 1) 1399 return (NULL); 1400 1401 /* Check only at the very beginning. */ 1402 if (!(sc->sc_flags & UPGT_FLAG_FWLOADED) && 1403 (memcmp(data->buf, "OK", 2) == 0)) { 1404 sc->sc_flags |= UPGT_FLAG_FWLOADED; 1405 wakeup_one(sc); 1406 return (NULL); 1407 } 1408 1409 if (actlen < (int)UPGT_RX_MINSZ) 1410 return (NULL); 1411 1412 /* 1413 * Check what type of frame came in. 1414 */ 1415 header = (struct upgt_lmac_header *)(data->buf + 4); 1416 1417 h1_type = header->header1.type; 1418 h2_type = le16toh(header->header2.type); 1419 1420 if (h1_type == UPGT_H1_TYPE_CTRL && h2_type == UPGT_H2_TYPE_EEPROM) { 1421 eeprom = (struct upgt_lmac_eeprom *)(data->buf + 4); 1422 uint16_t eeprom_offset = le16toh(eeprom->offset); 1423 uint16_t eeprom_len = le16toh(eeprom->len); 1424 1425 DPRINTF(sc, UPGT_DEBUG_FW, 1426 "received EEPROM block (offset=%d, len=%d)\n", 1427 eeprom_offset, eeprom_len); 1428 1429 memcpy(sc->sc_eeprom + eeprom_offset, 1430 data->buf + sizeof(struct upgt_lmac_eeprom) + 4, 1431 eeprom_len); 1432 1433 /* EEPROM data has arrived in time, wakeup. */ 1434 wakeup(sc); 1435 } else if (h1_type == UPGT_H1_TYPE_CTRL && 1436 h2_type == UPGT_H2_TYPE_TX_DONE) { 1437 DPRINTF(sc, UPGT_DEBUG_XMIT, "%s: received 802.11 TX done\n", 1438 __func__); 1439 upgt_tx_done(sc, data->buf + 4); 1440 } else if (h1_type == UPGT_H1_TYPE_RX_DATA || 1441 h1_type == UPGT_H1_TYPE_RX_DATA_MGMT) { 1442 DPRINTF(sc, UPGT_DEBUG_RECV, "%s: received 802.11 RX data\n", 1443 __func__); 1444 m = upgt_rx(sc, data->buf + 4, le16toh(header->header1.len), 1445 rssi); 1446 } else if (h1_type == UPGT_H1_TYPE_CTRL && 1447 h2_type == UPGT_H2_TYPE_STATS) { 1448 DPRINTF(sc, UPGT_DEBUG_STAT, "%s: received statistic data\n", 1449 __func__); 1450 /* TODO: what could we do with the statistic data? */ 1451 } else { 1452 /* ignore unknown frame types */ 1453 DPRINTF(sc, UPGT_DEBUG_INTR, 1454 "received unknown frame type 0x%02x\n", 1455 header->header1.type); 1456 } 1457 return (m); 1458} 1459 1460/* 1461 * The firmware awaits a checksum for each frame we send to it. 1462 * The algorithm used therefor is uncommon but somehow similar to CRC32. 1463 */ 1464static uint32_t 1465upgt_chksum_le(const uint32_t *buf, size_t size) 1466{ 1467 size_t i; 1468 uint32_t crc = 0; 1469 1470 for (i = 0; i < size; i += sizeof(uint32_t)) { 1471 crc = htole32(crc ^ *buf++); 1472 crc = htole32((crc >> 5) ^ (crc << 3)); 1473 } 1474 1475 return (crc); 1476} 1477 1478static struct mbuf * 1479upgt_rx(struct upgt_softc *sc, uint8_t *data, int pkglen, int *rssi) 1480{ 1481 struct ifnet *ifp = sc->sc_ifp; 1482 struct ieee80211com *ic = ifp->if_l2com; 1483 struct upgt_lmac_rx_desc *rxdesc; 1484 struct mbuf *m; 1485 1486 /* 1487 * don't pass packets to the ieee80211 framework if the driver isn't 1488 * RUNNING. 1489 */ 1490 if (!(ifp->if_drv_flags & IFF_DRV_RUNNING)) 1491 return (NULL); 1492 1493 /* access RX packet descriptor */ 1494 rxdesc = (struct upgt_lmac_rx_desc *)data; 1495 1496 /* create mbuf which is suitable for strict alignment archs */ 1497 KASSERT((pkglen + ETHER_ALIGN) < MCLBYTES, 1498 ("A current mbuf storage is small (%d)", pkglen + ETHER_ALIGN)); 1499 m = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR); 1500 if (m == NULL) { 1501 device_printf(sc->sc_dev, "could not create RX mbuf\n"); 1502 return (NULL); 1503 } 1504 m_adj(m, ETHER_ALIGN); 1505 memcpy(mtod(m, char *), rxdesc->data, pkglen); 1506 /* trim FCS */ 1507 m->m_len = m->m_pkthdr.len = pkglen - IEEE80211_CRC_LEN; 1508 m->m_pkthdr.rcvif = ifp; 1509 1510 if (ieee80211_radiotap_active(ic)) { 1511 struct upgt_rx_radiotap_header *tap = &sc->sc_rxtap; 1512 1513 tap->wr_flags = 0; 1514 tap->wr_rate = upgt_rx_rate(sc, rxdesc->rate); 1515 tap->wr_antsignal = rxdesc->rssi; 1516 } 1517 ifp->if_ipackets++; 1518 1519 DPRINTF(sc, UPGT_DEBUG_RX_PROC, "%s: RX done\n", __func__); 1520 *rssi = rxdesc->rssi; 1521 return (m); 1522} 1523 1524static uint8_t 1525upgt_rx_rate(struct upgt_softc *sc, const int rate) 1526{ 1527 struct ifnet *ifp = sc->sc_ifp; 1528 struct ieee80211com *ic = ifp->if_l2com; 1529 static const uint8_t cck_upgt2rate[4] = { 2, 4, 11, 22 }; 1530 static const uint8_t ofdm_upgt2rate[12] = 1531 { 2, 4, 11, 22, 12, 18, 24, 36, 48, 72, 96, 108 }; 1532 1533 if (ic->ic_curmode == IEEE80211_MODE_11B && 1534 !(rate < 0 || rate > 3)) 1535 return cck_upgt2rate[rate & 0xf]; 1536 1537 if (ic->ic_curmode == IEEE80211_MODE_11G && 1538 !(rate < 0 || rate > 11)) 1539 return ofdm_upgt2rate[rate & 0xf]; 1540 1541 return (0); 1542} 1543 1544static void 1545upgt_tx_done(struct upgt_softc *sc, uint8_t *data) 1546{ 1547 struct ifnet *ifp = sc->sc_ifp; 1548 struct upgt_lmac_tx_done_desc *desc; 1549 int i, freed = 0; 1550 1551 UPGT_ASSERT_LOCKED(sc); 1552 1553 desc = (struct upgt_lmac_tx_done_desc *)data; 1554 1555 for (i = 0; i < UPGT_TX_MAXCOUNT; i++) { 1556 struct upgt_data *data_tx = &sc->sc_tx_data[i]; 1557 1558 if (data_tx->addr == le32toh(desc->header2.reqid)) { 1559 upgt_mem_free(sc, data_tx->addr); 1560 data_tx->ni = NULL; 1561 data_tx->addr = 0; 1562 data_tx->m = NULL; 1563 data_tx->use = 0; 1564 1565 DPRINTF(sc, UPGT_DEBUG_TX_PROC, 1566 "TX done: memaddr=0x%08x, status=0x%04x, rssi=%d, ", 1567 le32toh(desc->header2.reqid), 1568 le16toh(desc->status), le16toh(desc->rssi)); 1569 DPRINTF(sc, UPGT_DEBUG_TX_PROC, "seq=%d\n", 1570 le16toh(desc->seq)); 1571 1572 freed++; 1573 } 1574 } 1575 1576 if (freed != 0) { 1577 sc->sc_tx_timer = 0; 1578 ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 1579 UPGT_UNLOCK(sc); 1580 upgt_start(ifp); 1581 UPGT_LOCK(sc); 1582 } 1583} 1584 1585static void 1586upgt_mem_free(struct upgt_softc *sc, uint32_t addr) 1587{ 1588 int i; 1589 1590 for (i = 0; i < sc->sc_memory.pages; i++) { 1591 if (sc->sc_memory.page[i].addr == addr) { 1592 sc->sc_memory.page[i].used = 0; 1593 return; 1594 } 1595 } 1596 1597 device_printf(sc->sc_dev, 1598 "could not free memory address 0x%08x\n", addr); 1599} 1600 1601static int 1602upgt_fw_load(struct upgt_softc *sc) 1603{ 1604 const struct firmware *fw; 1605 struct upgt_data *data_cmd; 1606 struct upgt_fw_x2_header *x2; 1607 char start_fwload_cmd[] = { 0x3c, 0x0d }; 1608 int error = 0; 1609 size_t offset; 1610 int bsize; 1611 int n; 1612 uint32_t crc32; 1613 1614 fw = firmware_get(upgt_fwname); 1615 if (fw == NULL) { 1616 device_printf(sc->sc_dev, "could not read microcode %s\n", 1617 upgt_fwname); 1618 return (EIO); 1619 } 1620 1621 UPGT_LOCK(sc); 1622 1623 /* send firmware start load command */ 1624 data_cmd = upgt_getbuf(sc); 1625 if (data_cmd == NULL) { 1626 error = ENOBUFS; 1627 goto fail; 1628 } 1629 data_cmd->buflen = sizeof(start_fwload_cmd); 1630 memcpy(data_cmd->buf, start_fwload_cmd, data_cmd->buflen); 1631 upgt_bulk_tx(sc, data_cmd); 1632 1633 /* send X2 header */ 1634 data_cmd = upgt_getbuf(sc); 1635 if (data_cmd == NULL) { 1636 error = ENOBUFS; 1637 goto fail; 1638 } 1639 data_cmd->buflen = sizeof(struct upgt_fw_x2_header); 1640 x2 = (struct upgt_fw_x2_header *)data_cmd->buf; 1641 memcpy(x2->signature, UPGT_X2_SIGNATURE, UPGT_X2_SIGNATURE_SIZE); 1642 x2->startaddr = htole32(UPGT_MEMADDR_FIRMWARE_START); 1643 x2->len = htole32(fw->datasize); 1644 x2->crc = upgt_crc32_le((uint8_t *)data_cmd->buf + 1645 UPGT_X2_SIGNATURE_SIZE, 1646 sizeof(struct upgt_fw_x2_header) - UPGT_X2_SIGNATURE_SIZE - 1647 sizeof(uint32_t)); 1648 upgt_bulk_tx(sc, data_cmd); 1649 1650 /* download firmware */ 1651 for (offset = 0; offset < fw->datasize; offset += bsize) { 1652 if (fw->datasize - offset > UPGT_FW_BLOCK_SIZE) 1653 bsize = UPGT_FW_BLOCK_SIZE; 1654 else 1655 bsize = fw->datasize - offset; 1656 1657 data_cmd = upgt_getbuf(sc); 1658 if (data_cmd == NULL) { 1659 error = ENOBUFS; 1660 goto fail; 1661 } 1662 n = upgt_fw_copy((const uint8_t *)fw->data + offset, 1663 data_cmd->buf, bsize); 1664 data_cmd->buflen = bsize; 1665 upgt_bulk_tx(sc, data_cmd); 1666 1667 DPRINTF(sc, UPGT_DEBUG_FW, "FW offset=%d, read=%d, sent=%d\n", 1668 offset, n, bsize); 1669 bsize = n; 1670 } 1671 DPRINTF(sc, UPGT_DEBUG_FW, "%s: firmware downloaded\n", __func__); 1672 1673 /* load firmware */ 1674 data_cmd = upgt_getbuf(sc); 1675 if (data_cmd == NULL) { 1676 error = ENOBUFS; 1677 goto fail; 1678 } 1679 crc32 = upgt_crc32_le(fw->data, fw->datasize); 1680 *((uint32_t *)(data_cmd->buf) ) = crc32; 1681 *((uint8_t *)(data_cmd->buf) + 4) = 'g'; 1682 *((uint8_t *)(data_cmd->buf) + 5) = '\r'; 1683 data_cmd->buflen = 6; 1684 upgt_bulk_tx(sc, data_cmd); 1685 1686 /* waiting 'OK' response. */ 1687 usbd_transfer_start(sc->sc_xfer[UPGT_BULK_RX]); 1688 error = mtx_sleep(sc, &sc->sc_mtx, 0, "upgtfw", 2 * hz); 1689 if (error != 0) { 1690 device_printf(sc->sc_dev, "firmware load failed\n"); 1691 error = EIO; 1692 } 1693 1694 DPRINTF(sc, UPGT_DEBUG_FW, "%s: firmware loaded\n", __func__); 1695fail: 1696 UPGT_UNLOCK(sc); 1697 firmware_put(fw, FIRMWARE_UNLOAD); 1698 return (error); 1699} 1700 1701static uint32_t 1702upgt_crc32_le(const void *buf, size_t size) 1703{ 1704 uint32_t crc; 1705 1706 crc = ether_crc32_le(buf, size); 1707 1708 /* apply final XOR value as common for CRC-32 */ 1709 crc = htole32(crc ^ 0xffffffffU); 1710 1711 return (crc); 1712} 1713 1714/* 1715 * While copying the version 2 firmware, we need to replace two characters: 1716 * 1717 * 0x7e -> 0x7d 0x5e 1718 * 0x7d -> 0x7d 0x5d 1719 */ 1720static int 1721upgt_fw_copy(const uint8_t *src, char *dst, int size) 1722{ 1723 int i, j; 1724 1725 for (i = 0, j = 0; i < size && j < size; i++) { 1726 switch (src[i]) { 1727 case 0x7e: 1728 dst[j] = 0x7d; 1729 j++; 1730 dst[j] = 0x5e; 1731 j++; 1732 break; 1733 case 0x7d: 1734 dst[j] = 0x7d; 1735 j++; 1736 dst[j] = 0x5d; 1737 j++; 1738 break; 1739 default: 1740 dst[j] = src[i]; 1741 j++; 1742 break; 1743 } 1744 } 1745 1746 return (i); 1747} 1748 1749static int 1750upgt_mem_init(struct upgt_softc *sc) 1751{ 1752 int i; 1753 1754 for (i = 0; i < UPGT_MEMORY_MAX_PAGES; i++) { 1755 sc->sc_memory.page[i].used = 0; 1756 1757 if (i == 0) { 1758 /* 1759 * The first memory page is always reserved for 1760 * command data. 1761 */ 1762 sc->sc_memory.page[i].addr = 1763 sc->sc_memaddr_frame_start + MCLBYTES; 1764 } else { 1765 sc->sc_memory.page[i].addr = 1766 sc->sc_memory.page[i - 1].addr + MCLBYTES; 1767 } 1768 1769 if (sc->sc_memory.page[i].addr + MCLBYTES >= 1770 sc->sc_memaddr_frame_end) 1771 break; 1772 1773 DPRINTF(sc, UPGT_DEBUG_FW, "memory address page %d=0x%08x\n", 1774 i, sc->sc_memory.page[i].addr); 1775 } 1776 1777 sc->sc_memory.pages = i; 1778 1779 DPRINTF(sc, UPGT_DEBUG_FW, "memory pages=%d\n", sc->sc_memory.pages); 1780 return (0); 1781} 1782 1783static int 1784upgt_fw_verify(struct upgt_softc *sc) 1785{ 1786 const struct firmware *fw; 1787 const struct upgt_fw_bra_option *bra_opt; 1788 const struct upgt_fw_bra_descr *descr; 1789 const uint8_t *p; 1790 const uint32_t *uc; 1791 uint32_t bra_option_type, bra_option_len; 1792 size_t offset; 1793 int bra_end = 0; 1794 int error = 0; 1795 1796 fw = firmware_get(upgt_fwname); 1797 if (fw == NULL) { 1798 device_printf(sc->sc_dev, "could not read microcode %s\n", 1799 upgt_fwname); 1800 return EIO; 1801 } 1802 1803 /* 1804 * Seek to beginning of Boot Record Area (BRA). 1805 */ 1806 for (offset = 0; offset < fw->datasize; offset += sizeof(*uc)) { 1807 uc = (const uint32_t *)((const uint8_t *)fw->data + offset); 1808 if (*uc == 0) 1809 break; 1810 } 1811 for (; offset < fw->datasize; offset += sizeof(*uc)) { 1812 uc = (const uint32_t *)((const uint8_t *)fw->data + offset); 1813 if (*uc != 0) 1814 break; 1815 } 1816 if (offset == fw->datasize) { 1817 device_printf(sc->sc_dev, 1818 "firmware Boot Record Area not found\n"); 1819 error = EIO; 1820 goto fail; 1821 } 1822 1823 DPRINTF(sc, UPGT_DEBUG_FW, 1824 "firmware Boot Record Area found at offset %d\n", offset); 1825 1826 /* 1827 * Parse Boot Record Area (BRA) options. 1828 */ 1829 while (offset < fw->datasize && bra_end == 0) { 1830 /* get current BRA option */ 1831 p = (const uint8_t *)fw->data + offset; 1832 bra_opt = (const struct upgt_fw_bra_option *)p; 1833 bra_option_type = le32toh(bra_opt->type); 1834 bra_option_len = le32toh(bra_opt->len) * sizeof(*uc); 1835 1836 switch (bra_option_type) { 1837 case UPGT_BRA_TYPE_FW: 1838 DPRINTF(sc, UPGT_DEBUG_FW, "UPGT_BRA_TYPE_FW len=%d\n", 1839 bra_option_len); 1840 1841 if (bra_option_len != UPGT_BRA_FWTYPE_SIZE) { 1842 device_printf(sc->sc_dev, 1843 "wrong UPGT_BRA_TYPE_FW len\n"); 1844 error = EIO; 1845 goto fail; 1846 } 1847 if (memcmp(UPGT_BRA_FWTYPE_LM86, bra_opt->data, 1848 bra_option_len) == 0) { 1849 sc->sc_fw_type = UPGT_FWTYPE_LM86; 1850 break; 1851 } 1852 if (memcmp(UPGT_BRA_FWTYPE_LM87, bra_opt->data, 1853 bra_option_len) == 0) { 1854 sc->sc_fw_type = UPGT_FWTYPE_LM87; 1855 break; 1856 } 1857 device_printf(sc->sc_dev, 1858 "unsupported firmware type\n"); 1859 error = EIO; 1860 goto fail; 1861 case UPGT_BRA_TYPE_VERSION: 1862 DPRINTF(sc, UPGT_DEBUG_FW, 1863 "UPGT_BRA_TYPE_VERSION len=%d\n", bra_option_len); 1864 break; 1865 case UPGT_BRA_TYPE_DEPIF: 1866 DPRINTF(sc, UPGT_DEBUG_FW, 1867 "UPGT_BRA_TYPE_DEPIF len=%d\n", bra_option_len); 1868 break; 1869 case UPGT_BRA_TYPE_EXPIF: 1870 DPRINTF(sc, UPGT_DEBUG_FW, 1871 "UPGT_BRA_TYPE_EXPIF len=%d\n", bra_option_len); 1872 break; 1873 case UPGT_BRA_TYPE_DESCR: 1874 DPRINTF(sc, UPGT_DEBUG_FW, 1875 "UPGT_BRA_TYPE_DESCR len=%d\n", bra_option_len); 1876 1877 descr = (const struct upgt_fw_bra_descr *)bra_opt->data; 1878 1879 sc->sc_memaddr_frame_start = 1880 le32toh(descr->memaddr_space_start); 1881 sc->sc_memaddr_frame_end = 1882 le32toh(descr->memaddr_space_end); 1883 1884 DPRINTF(sc, UPGT_DEBUG_FW, 1885 "memory address space start=0x%08x\n", 1886 sc->sc_memaddr_frame_start); 1887 DPRINTF(sc, UPGT_DEBUG_FW, 1888 "memory address space end=0x%08x\n", 1889 sc->sc_memaddr_frame_end); 1890 break; 1891 case UPGT_BRA_TYPE_END: 1892 DPRINTF(sc, UPGT_DEBUG_FW, "UPGT_BRA_TYPE_END len=%d\n", 1893 bra_option_len); 1894 bra_end = 1; 1895 break; 1896 default: 1897 DPRINTF(sc, UPGT_DEBUG_FW, "unknown BRA option len=%d\n", 1898 bra_option_len); 1899 error = EIO; 1900 goto fail; 1901 } 1902 1903 /* jump to next BRA option */ 1904 offset += sizeof(struct upgt_fw_bra_option) + bra_option_len; 1905 } 1906 1907 DPRINTF(sc, UPGT_DEBUG_FW, "%s: firmware verified", __func__); 1908fail: 1909 firmware_put(fw, FIRMWARE_UNLOAD); 1910 return (error); 1911} 1912 1913static void 1914upgt_bulk_tx(struct upgt_softc *sc, struct upgt_data *data) 1915{ 1916 1917 UPGT_ASSERT_LOCKED(sc); 1918 1919 STAILQ_INSERT_TAIL(&sc->sc_tx_pending, data, next); 1920 UPGT_STAT_INC(sc, st_tx_pending); 1921 usbd_transfer_start(sc->sc_xfer[UPGT_BULK_TX]); 1922} 1923 1924static int 1925upgt_device_reset(struct upgt_softc *sc) 1926{ 1927 struct upgt_data *data; 1928 char init_cmd[] = { 0x7e, 0x7e, 0x7e, 0x7e }; 1929 1930 UPGT_LOCK(sc); 1931 1932 data = upgt_getbuf(sc); 1933 if (data == NULL) { 1934 UPGT_UNLOCK(sc); 1935 return (ENOBUFS); 1936 } 1937 memcpy(data->buf, init_cmd, sizeof(init_cmd)); 1938 data->buflen = sizeof(init_cmd); 1939 upgt_bulk_tx(sc, data); 1940 usb_pause_mtx(&sc->sc_mtx, 100); 1941 1942 UPGT_UNLOCK(sc); 1943 DPRINTF(sc, UPGT_DEBUG_FW, "%s: device initialized\n", __func__); 1944 return (0); 1945} 1946 1947static int 1948upgt_alloc_tx(struct upgt_softc *sc) 1949{ 1950 int i; 1951 1952 STAILQ_INIT(&sc->sc_tx_active); 1953 STAILQ_INIT(&sc->sc_tx_inactive); 1954 STAILQ_INIT(&sc->sc_tx_pending); 1955 1956 for (i = 0; i < UPGT_TX_MAXCOUNT; i++) { 1957 struct upgt_data *data = &sc->sc_tx_data[i];
|