if_upgt.c revision 1.2.2.2
1 1.2.2.2 yamt /* $NetBSD: if_upgt.c,v 1.2.2.2 2010/08/11 22:54:14 yamt Exp $ */ 2 1.2.2.2 yamt /* $OpenBSD: if_upgt.c,v 1.49 2010/04/20 22:05:43 tedu Exp $ */ 3 1.2.2.2 yamt 4 1.2.2.2 yamt /* 5 1.2.2.2 yamt * Copyright (c) 2007 Marcus Glocker <mglocker (at) openbsd.org> 6 1.2.2.2 yamt * 7 1.2.2.2 yamt * Permission to use, copy, modify, and distribute this software for any 8 1.2.2.2 yamt * purpose with or without fee is hereby granted, provided that the above 9 1.2.2.2 yamt * copyright notice and this permission notice appear in all copies. 10 1.2.2.2 yamt * 11 1.2.2.2 yamt * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 12 1.2.2.2 yamt * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 13 1.2.2.2 yamt * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 14 1.2.2.2 yamt * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 15 1.2.2.2 yamt * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 16 1.2.2.2 yamt * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 17 1.2.2.2 yamt * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 18 1.2.2.2 yamt */ 19 1.2.2.2 yamt 20 1.2.2.2 yamt #include <sys/cdefs.h> 21 1.2.2.2 yamt __KERNEL_RCSID(0, "$NetBSD: if_upgt.c,v 1.2.2.2 2010/08/11 22:54:14 yamt Exp $"); 22 1.2.2.2 yamt 23 1.2.2.2 yamt #include <sys/param.h> 24 1.2.2.2 yamt #include <sys/callout.h> 25 1.2.2.2 yamt #include <sys/device.h> 26 1.2.2.2 yamt #include <sys/errno.h> 27 1.2.2.2 yamt #include <sys/kernel.h> 28 1.2.2.2 yamt #include <sys/kthread.h> 29 1.2.2.2 yamt #include <sys/mbuf.h> 30 1.2.2.2 yamt #include <sys/proc.h> 31 1.2.2.2 yamt #include <sys/sockio.h> 32 1.2.2.2 yamt #include <sys/systm.h> 33 1.2.2.2 yamt #include <sys/vnode.h> 34 1.2.2.2 yamt 35 1.2.2.2 yamt #include <sys/bus.h> 36 1.2.2.2 yamt #include <sys/endian.h> 37 1.2.2.2 yamt #include <sys/intr.h> 38 1.2.2.2 yamt 39 1.2.2.2 yamt #include <net/bpf.h> 40 1.2.2.2 yamt #include <net/if.h> 41 1.2.2.2 yamt #include <net/if_arp.h> 42 1.2.2.2 yamt #include <net/if_dl.h> 43 1.2.2.2 yamt #include <net/if_ether.h> 44 1.2.2.2 yamt #include <net/if_media.h> 45 1.2.2.2 yamt #include <net/if_types.h> 46 1.2.2.2 yamt 47 1.2.2.2 yamt #include <net80211/ieee80211_var.h> 48 1.2.2.2 yamt #include <net80211/ieee80211_radiotap.h> 49 1.2.2.2 yamt 50 1.2.2.2 yamt #include <dev/firmload.h> 51 1.2.2.2 yamt 52 1.2.2.2 yamt #include <dev/usb/usb.h> 53 1.2.2.2 yamt #include <dev/usb/usbdi.h> 54 1.2.2.2 yamt #include <dev/usb/usbdi_util.h> 55 1.2.2.2 yamt #include <dev/usb/usbdevs.h> 56 1.2.2.2 yamt 57 1.2.2.2 yamt #include <dev/usb/if_upgtvar.h> 58 1.2.2.2 yamt 59 1.2.2.2 yamt /* 60 1.2.2.2 yamt * Driver for the USB PrismGT devices. 61 1.2.2.2 yamt * 62 1.2.2.2 yamt * For now just USB 2.0 devices with the GW3887 chipset are supported. 63 1.2.2.2 yamt * The driver has been written based on the firmware version 2.13.1.0_LM87. 64 1.2.2.2 yamt * 65 1.2.2.2 yamt * TODO's: 66 1.2.2.2 yamt * - Fix MONITOR mode (MAC filter). 67 1.2.2.2 yamt * - Add HOSTAP mode. 68 1.2.2.2 yamt * - Add IBSS mode. 69 1.2.2.2 yamt * - Support the USB 1.0 devices (NET2280, ISL3880, ISL3886 chipsets). 70 1.2.2.2 yamt * 71 1.2.2.2 yamt * Parts of this driver has been influenced by reading the p54u driver 72 1.2.2.2 yamt * written by Jean-Baptiste Note <jean-baptiste.note (at) m4x.org> and 73 1.2.2.2 yamt * Sebastien Bourdeauducq <lekernel (at) prism54.org>. 74 1.2.2.2 yamt */ 75 1.2.2.2 yamt 76 1.2.2.2 yamt #ifdef UPGT_DEBUG 77 1.2.2.2 yamt int upgt_debug = 2; 78 1.2.2.2 yamt #define DPRINTF(l, x...) do { if ((l) <= upgt_debug) printf(x); } while (0) 79 1.2.2.2 yamt #else 80 1.2.2.2 yamt #define DPRINTF(l, x...) 81 1.2.2.2 yamt #endif 82 1.2.2.2 yamt 83 1.2.2.2 yamt /* 84 1.2.2.2 yamt * Prototypes. 85 1.2.2.2 yamt */ 86 1.2.2.2 yamt static int upgt_match(device_t, cfdata_t, void *); 87 1.2.2.2 yamt static void upgt_attach(device_t, device_t, void *); 88 1.2.2.2 yamt static int upgt_detach(device_t, int); 89 1.2.2.2 yamt static int upgt_activate(device_t, devact_t); 90 1.2.2.2 yamt 91 1.2.2.2 yamt static void upgt_attach_hook(device_t); 92 1.2.2.2 yamt static int upgt_device_type(struct upgt_softc *, uint16_t, uint16_t); 93 1.2.2.2 yamt static int upgt_device_init(struct upgt_softc *); 94 1.2.2.2 yamt static int upgt_mem_init(struct upgt_softc *); 95 1.2.2.2 yamt static uint32_t upgt_mem_alloc(struct upgt_softc *); 96 1.2.2.2 yamt static void upgt_mem_free(struct upgt_softc *, uint32_t); 97 1.2.2.2 yamt static int upgt_fw_alloc(struct upgt_softc *); 98 1.2.2.2 yamt static void upgt_fw_free(struct upgt_softc *); 99 1.2.2.2 yamt static int upgt_fw_verify(struct upgt_softc *); 100 1.2.2.2 yamt static int upgt_fw_load(struct upgt_softc *); 101 1.2.2.2 yamt static int upgt_fw_copy(char *, char *, int); 102 1.2.2.2 yamt static int upgt_eeprom_read(struct upgt_softc *); 103 1.2.2.2 yamt static int upgt_eeprom_parse(struct upgt_softc *); 104 1.2.2.2 yamt static void upgt_eeprom_parse_hwrx(struct upgt_softc *, uint8_t *); 105 1.2.2.2 yamt static void upgt_eeprom_parse_freq3(struct upgt_softc *, uint8_t *, int); 106 1.2.2.2 yamt static void upgt_eeprom_parse_freq4(struct upgt_softc *, uint8_t *, int); 107 1.2.2.2 yamt static void upgt_eeprom_parse_freq6(struct upgt_softc *, uint8_t *, int); 108 1.2.2.2 yamt 109 1.2.2.2 yamt static int upgt_ioctl(struct ifnet *, u_long, void *); 110 1.2.2.2 yamt static int upgt_init(struct ifnet *); 111 1.2.2.2 yamt static void upgt_stop(struct upgt_softc *); 112 1.2.2.2 yamt static int upgt_media_change(struct ifnet *); 113 1.2.2.2 yamt static void upgt_newassoc(struct ieee80211_node *, int); 114 1.2.2.2 yamt static int upgt_newstate(struct ieee80211com *, enum ieee80211_state, 115 1.2.2.2 yamt int); 116 1.2.2.2 yamt static void upgt_newstate_task(void *); 117 1.2.2.2 yamt static void upgt_next_scan(void *); 118 1.2.2.2 yamt static void upgt_start(struct ifnet *); 119 1.2.2.2 yamt static void upgt_watchdog(struct ifnet *); 120 1.2.2.2 yamt static void upgt_tx_task(void *); 121 1.2.2.2 yamt static void upgt_tx_done(struct upgt_softc *, uint8_t *); 122 1.2.2.2 yamt static void upgt_rx_cb(usbd_xfer_handle, usbd_private_handle, usbd_status); 123 1.2.2.2 yamt static void upgt_rx(struct upgt_softc *, uint8_t *, int); 124 1.2.2.2 yamt static void upgt_setup_rates(struct upgt_softc *); 125 1.2.2.2 yamt static uint8_t upgt_rx_rate(struct upgt_softc *, const int); 126 1.2.2.2 yamt static int upgt_set_macfilter(struct upgt_softc *, uint8_t state); 127 1.2.2.2 yamt static int upgt_set_channel(struct upgt_softc *, unsigned); 128 1.2.2.2 yamt static void upgt_set_led(struct upgt_softc *, int); 129 1.2.2.2 yamt static void upgt_set_led_blink(void *); 130 1.2.2.2 yamt static int upgt_get_stats(struct upgt_softc *); 131 1.2.2.2 yamt 132 1.2.2.2 yamt static int upgt_alloc_tx(struct upgt_softc *); 133 1.2.2.2 yamt static int upgt_alloc_rx(struct upgt_softc *); 134 1.2.2.2 yamt static int upgt_alloc_cmd(struct upgt_softc *); 135 1.2.2.2 yamt static void upgt_free_tx(struct upgt_softc *); 136 1.2.2.2 yamt static void upgt_free_rx(struct upgt_softc *); 137 1.2.2.2 yamt static void upgt_free_cmd(struct upgt_softc *); 138 1.2.2.2 yamt static int upgt_bulk_xmit(struct upgt_softc *, struct upgt_data *, 139 1.2.2.2 yamt usbd_pipe_handle, uint32_t *, int); 140 1.2.2.2 yamt 141 1.2.2.2 yamt #if 0 142 1.2.2.2 yamt static void upgt_hexdump(void *, int); 143 1.2.2.2 yamt #endif 144 1.2.2.2 yamt static uint32_t upgt_crc32_le(const void *, size_t); 145 1.2.2.2 yamt static uint32_t upgt_chksum_le(const uint32_t *, size_t); 146 1.2.2.2 yamt 147 1.2.2.2 yamt CFATTACH_DECL_NEW(upgt, sizeof(struct upgt_softc), 148 1.2.2.2 yamt upgt_match, upgt_attach, upgt_detach, upgt_activate); 149 1.2.2.2 yamt 150 1.2.2.2 yamt static const struct usb_devno upgt_devs_1[] = { 151 1.2.2.2 yamt /* version 1 devices */ 152 1.2.2.2 yamt { USB_VENDOR_ALCATELT, USB_PRODUCT_ALCATELT_ST120G } 153 1.2.2.2 yamt }; 154 1.2.2.2 yamt 155 1.2.2.2 yamt static const struct usb_devno upgt_devs_2[] = { 156 1.2.2.2 yamt /* version 2 devices */ 157 1.2.2.2 yamt { USB_VENDOR_ACCTON, USB_PRODUCT_ACCTON_PRISM_GT }, 158 1.2.2.2 yamt { USB_VENDOR_ALCATELT, USB_PRODUCT_ALCATELT_ST121G }, 159 1.2.2.2 yamt { USB_VENDOR_BELKIN, USB_PRODUCT_BELKIN_F5D7050 }, 160 1.2.2.2 yamt { USB_VENDOR_CISCOLINKSYS, USB_PRODUCT_CISCOLINKSYS_WUSB54AG }, 161 1.2.2.2 yamt { USB_VENDOR_CISCOLINKSYS, USB_PRODUCT_CISCOLINKSYS_WUSB54GV2 }, 162 1.2.2.2 yamt { USB_VENDOR_CONCEPTRONIC2, USB_PRODUCT_CONCEPTRONIC2_PRISM_GT }, 163 1.2.2.2 yamt { USB_VENDOR_COREGA, USB_PRODUCT_COREGA_CGWLUSB2GTST }, 164 1.2.2.2 yamt { USB_VENDOR_DELL, USB_PRODUCT_DELL_PRISM_GT_1 }, 165 1.2.2.2 yamt { USB_VENDOR_DELL, USB_PRODUCT_DELL_PRISM_GT_2 }, 166 1.2.2.2 yamt { USB_VENDOR_DLINK, USB_PRODUCT_DLINK_DWLG122A2 }, 167 1.2.2.2 yamt { USB_VENDOR_FSC, USB_PRODUCT_FSC_E5400 }, 168 1.2.2.2 yamt { USB_VENDOR_GLOBESPAN, USB_PRODUCT_GLOBESPAN_PRISM_GT_1 }, 169 1.2.2.2 yamt { USB_VENDOR_GLOBESPAN, USB_PRODUCT_GLOBESPAN_PRISM_GT_2 }, 170 1.2.2.2 yamt { USB_VENDOR_INTERSIL, USB_PRODUCT_INTERSIL_PRISM_GT }, 171 1.2.2.2 yamt { USB_VENDOR_PHEENET, USB_PRODUCT_PHEENET_GWU513 }, 172 1.2.2.2 yamt { USB_VENDOR_PHILIPS, USB_PRODUCT_PHILIPS_CPWUA054 }, 173 1.2.2.2 yamt { USB_VENDOR_SHARP, USB_PRODUCT_SHARP_RUITZ1016YCZZ }, 174 1.2.2.2 yamt { USB_VENDOR_SMC, USB_PRODUCT_SMC_2862WG }, 175 1.2.2.2 yamt { USB_VENDOR_USR, USB_PRODUCT_USR_USR5422 }, 176 1.2.2.2 yamt { USB_VENDOR_WISTRONNEWEB, USB_PRODUCT_WISTRONNEWEB_UR045G }, 177 1.2.2.2 yamt { USB_VENDOR_XYRATEX, USB_PRODUCT_XYRATEX_PRISM_GT_1 }, 178 1.2.2.2 yamt { USB_VENDOR_XYRATEX, USB_PRODUCT_XYRATEX_PRISM_GT_2 }, 179 1.2.2.2 yamt { USB_VENDOR_ZCOM, USB_PRODUCT_ZCOM_MD40900 }, 180 1.2.2.2 yamt { USB_VENDOR_ZCOM, USB_PRODUCT_ZCOM_XG703A } 181 1.2.2.2 yamt }; 182 1.2.2.2 yamt 183 1.2.2.2 yamt static int 184 1.2.2.2 yamt firmware_load(const char *dname, const char *iname, uint8_t **ucodep, 185 1.2.2.2 yamt size_t *sizep) 186 1.2.2.2 yamt { 187 1.2.2.2 yamt firmware_handle_t fh; 188 1.2.2.2 yamt int error; 189 1.2.2.2 yamt 190 1.2.2.2 yamt if ((error = firmware_open(dname, iname, &fh)) != 0) 191 1.2.2.2 yamt return error; 192 1.2.2.2 yamt *sizep = firmware_get_size(fh); 193 1.2.2.2 yamt if ((*ucodep = firmware_malloc(*sizep)) == NULL) { 194 1.2.2.2 yamt firmware_close(fh); 195 1.2.2.2 yamt return ENOMEM; 196 1.2.2.2 yamt } 197 1.2.2.2 yamt if ((error = firmware_read(fh, 0, *ucodep, *sizep)) != 0) 198 1.2.2.2 yamt firmware_free(*ucodep, *sizep); 199 1.2.2.2 yamt firmware_close(fh); 200 1.2.2.2 yamt 201 1.2.2.2 yamt return error; 202 1.2.2.2 yamt } 203 1.2.2.2 yamt 204 1.2.2.2 yamt static int 205 1.2.2.2 yamt upgt_match(device_t parent, cfdata_t match, void *aux) 206 1.2.2.2 yamt { 207 1.2.2.2 yamt struct usb_attach_arg *uaa = aux; 208 1.2.2.2 yamt 209 1.2.2.2 yamt if (usb_lookup(upgt_devs_1, uaa->vendor, uaa->product) != NULL) 210 1.2.2.2 yamt return UMATCH_VENDOR_PRODUCT; 211 1.2.2.2 yamt 212 1.2.2.2 yamt if (usb_lookup(upgt_devs_2, uaa->vendor, uaa->product) != NULL) 213 1.2.2.2 yamt return UMATCH_VENDOR_PRODUCT; 214 1.2.2.2 yamt 215 1.2.2.2 yamt return UMATCH_NONE; 216 1.2.2.2 yamt } 217 1.2.2.2 yamt 218 1.2.2.2 yamt static void 219 1.2.2.2 yamt upgt_attach(device_t parent, device_t self, void *aux) 220 1.2.2.2 yamt { 221 1.2.2.2 yamt struct upgt_softc *sc = device_private(self); 222 1.2.2.2 yamt struct usb_attach_arg *uaa = aux; 223 1.2.2.2 yamt usb_interface_descriptor_t *id; 224 1.2.2.2 yamt usb_endpoint_descriptor_t *ed; 225 1.2.2.2 yamt usbd_status error; 226 1.2.2.2 yamt char *devinfop; 227 1.2.2.2 yamt int i; 228 1.2.2.2 yamt 229 1.2.2.2 yamt aprint_naive("\n"); 230 1.2.2.2 yamt aprint_normal("\n"); 231 1.2.2.2 yamt 232 1.2.2.2 yamt /* 233 1.2.2.2 yamt * Attach USB device. 234 1.2.2.2 yamt */ 235 1.2.2.2 yamt sc->sc_dev = self; 236 1.2.2.2 yamt sc->sc_udev = uaa->device; 237 1.2.2.2 yamt 238 1.2.2.2 yamt devinfop = usbd_devinfo_alloc(sc->sc_udev, 0); 239 1.2.2.2 yamt aprint_normal_dev(sc->sc_dev, "%s\n", devinfop); 240 1.2.2.2 yamt usbd_devinfo_free(devinfop); 241 1.2.2.2 yamt 242 1.2.2.2 yamt /* check device type */ 243 1.2.2.2 yamt if (upgt_device_type(sc, uaa->vendor, uaa->product) != 0) 244 1.2.2.2 yamt return; 245 1.2.2.2 yamt 246 1.2.2.2 yamt /* set configuration number */ 247 1.2.2.2 yamt if (usbd_set_config_no(sc->sc_udev, UPGT_CONFIG_NO, 0) != 0) { 248 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 249 1.2.2.2 yamt "could not set configuration no\n"); 250 1.2.2.2 yamt return; 251 1.2.2.2 yamt } 252 1.2.2.2 yamt 253 1.2.2.2 yamt /* get the first interface handle */ 254 1.2.2.2 yamt error = usbd_device2interface_handle(sc->sc_udev, UPGT_IFACE_INDEX, 255 1.2.2.2 yamt &sc->sc_iface); 256 1.2.2.2 yamt if (error != 0) { 257 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 258 1.2.2.2 yamt "could not get interface handle\n"); 259 1.2.2.2 yamt return; 260 1.2.2.2 yamt } 261 1.2.2.2 yamt 262 1.2.2.2 yamt /* find endpoints */ 263 1.2.2.2 yamt id = usbd_get_interface_descriptor(sc->sc_iface); 264 1.2.2.2 yamt sc->sc_rx_no = sc->sc_tx_no = -1; 265 1.2.2.2 yamt for (i = 0; i < id->bNumEndpoints; i++) { 266 1.2.2.2 yamt ed = usbd_interface2endpoint_descriptor(sc->sc_iface, i); 267 1.2.2.2 yamt if (ed == NULL) { 268 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 269 1.2.2.2 yamt "no endpoint descriptor for iface %d\n", i); 270 1.2.2.2 yamt return; 271 1.2.2.2 yamt } 272 1.2.2.2 yamt 273 1.2.2.2 yamt if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_OUT && 274 1.2.2.2 yamt UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) 275 1.2.2.2 yamt sc->sc_tx_no = ed->bEndpointAddress; 276 1.2.2.2 yamt if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN && 277 1.2.2.2 yamt UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) 278 1.2.2.2 yamt sc->sc_rx_no = ed->bEndpointAddress; 279 1.2.2.2 yamt 280 1.2.2.2 yamt /* 281 1.2.2.2 yamt * 0x01 TX pipe 282 1.2.2.2 yamt * 0x81 RX pipe 283 1.2.2.2 yamt * 284 1.2.2.2 yamt * Deprecated scheme (not used with fw version >2.5.6.x): 285 1.2.2.2 yamt * 0x02 TX MGMT pipe 286 1.2.2.2 yamt * 0x82 TX MGMT pipe 287 1.2.2.2 yamt */ 288 1.2.2.2 yamt if (sc->sc_tx_no != -1 && sc->sc_rx_no != -1) 289 1.2.2.2 yamt break; 290 1.2.2.2 yamt } 291 1.2.2.2 yamt if (sc->sc_rx_no == -1 || sc->sc_tx_no == -1) { 292 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, "missing endpoint\n"); 293 1.2.2.2 yamt return; 294 1.2.2.2 yamt } 295 1.2.2.2 yamt 296 1.2.2.2 yamt /* setup tasks and timeouts */ 297 1.2.2.2 yamt usb_init_task(&sc->sc_task_newstate, upgt_newstate_task, sc); 298 1.2.2.2 yamt usb_init_task(&sc->sc_task_tx, upgt_tx_task, sc); 299 1.2.2.2 yamt callout_init(&sc->scan_to, 0); 300 1.2.2.2 yamt callout_setfunc(&sc->scan_to, upgt_next_scan, sc); 301 1.2.2.2 yamt callout_init(&sc->led_to, 0); 302 1.2.2.2 yamt callout_setfunc(&sc->led_to, upgt_set_led_blink, sc); 303 1.2.2.2 yamt 304 1.2.2.2 yamt /* 305 1.2.2.2 yamt * Open TX and RX USB bulk pipes. 306 1.2.2.2 yamt */ 307 1.2.2.2 yamt error = usbd_open_pipe(sc->sc_iface, sc->sc_tx_no, USBD_EXCLUSIVE_USE, 308 1.2.2.2 yamt &sc->sc_tx_pipeh); 309 1.2.2.2 yamt if (error != 0) { 310 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 311 1.2.2.2 yamt "could not open TX pipe: %s\n", usbd_errstr(error)); 312 1.2.2.2 yamt goto fail; 313 1.2.2.2 yamt } 314 1.2.2.2 yamt error = usbd_open_pipe(sc->sc_iface, sc->sc_rx_no, USBD_EXCLUSIVE_USE, 315 1.2.2.2 yamt &sc->sc_rx_pipeh); 316 1.2.2.2 yamt if (error != 0) { 317 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, "could not open RX pipe: %s\n", 318 1.2.2.2 yamt usbd_errstr(error)); 319 1.2.2.2 yamt goto fail; 320 1.2.2.2 yamt } 321 1.2.2.2 yamt 322 1.2.2.2 yamt /* 323 1.2.2.2 yamt * Allocate TX, RX, and CMD xfers. 324 1.2.2.2 yamt */ 325 1.2.2.2 yamt if (upgt_alloc_tx(sc) != 0) 326 1.2.2.2 yamt goto fail; 327 1.2.2.2 yamt if (upgt_alloc_rx(sc) != 0) 328 1.2.2.2 yamt goto fail; 329 1.2.2.2 yamt if (upgt_alloc_cmd(sc) != 0) 330 1.2.2.2 yamt goto fail; 331 1.2.2.2 yamt 332 1.2.2.2 yamt /* 333 1.2.2.2 yamt * We need the firmware loaded from file system to complete the attach. 334 1.2.2.2 yamt */ 335 1.2.2.2 yamt config_mountroot(self, upgt_attach_hook); 336 1.2.2.2 yamt 337 1.2.2.2 yamt return; 338 1.2.2.2 yamt fail: 339 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, "%s failed\n", __func__); 340 1.2.2.2 yamt } 341 1.2.2.2 yamt 342 1.2.2.2 yamt static void 343 1.2.2.2 yamt upgt_attach_hook(device_t arg) 344 1.2.2.2 yamt { 345 1.2.2.2 yamt struct upgt_softc *sc = device_private(arg); 346 1.2.2.2 yamt struct ieee80211com *ic = &sc->sc_ic; 347 1.2.2.2 yamt struct ifnet *ifp = &sc->sc_if; 348 1.2.2.2 yamt usbd_status error; 349 1.2.2.2 yamt int i; 350 1.2.2.2 yamt 351 1.2.2.2 yamt /* 352 1.2.2.2 yamt * Load firmware file into memory. 353 1.2.2.2 yamt */ 354 1.2.2.2 yamt if (upgt_fw_alloc(sc) != 0) 355 1.2.2.2 yamt goto fail; 356 1.2.2.2 yamt 357 1.2.2.2 yamt /* 358 1.2.2.2 yamt * Initialize the device. 359 1.2.2.2 yamt */ 360 1.2.2.2 yamt if (upgt_device_init(sc) != 0) 361 1.2.2.2 yamt goto fail; 362 1.2.2.2 yamt 363 1.2.2.2 yamt /* 364 1.2.2.2 yamt * Verify the firmware. 365 1.2.2.2 yamt */ 366 1.2.2.2 yamt if (upgt_fw_verify(sc) != 0) 367 1.2.2.2 yamt goto fail; 368 1.2.2.2 yamt 369 1.2.2.2 yamt /* 370 1.2.2.2 yamt * Calculate device memory space. 371 1.2.2.2 yamt */ 372 1.2.2.2 yamt if (sc->sc_memaddr_frame_start == 0 || sc->sc_memaddr_frame_end == 0) { 373 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 374 1.2.2.2 yamt "could not find memory space addresses on FW\n"); 375 1.2.2.2 yamt goto fail; 376 1.2.2.2 yamt } 377 1.2.2.2 yamt sc->sc_memaddr_frame_end -= UPGT_MEMSIZE_RX + 1; 378 1.2.2.2 yamt sc->sc_memaddr_rx_start = sc->sc_memaddr_frame_end + 1; 379 1.2.2.2 yamt 380 1.2.2.2 yamt DPRINTF(1, "%s: memory address frame start=0x%08x\n", 381 1.2.2.2 yamt device_xname(sc->sc_dev), sc->sc_memaddr_frame_start); 382 1.2.2.2 yamt DPRINTF(1, "%s: memory address frame end=0x%08x\n", 383 1.2.2.2 yamt device_xname(sc->sc_dev), sc->sc_memaddr_frame_end); 384 1.2.2.2 yamt DPRINTF(1, "%s: memory address rx start=0x%08x\n", 385 1.2.2.2 yamt device_xname(sc->sc_dev), sc->sc_memaddr_rx_start); 386 1.2.2.2 yamt 387 1.2.2.2 yamt upgt_mem_init(sc); 388 1.2.2.2 yamt 389 1.2.2.2 yamt /* 390 1.2.2.2 yamt * Load the firmware. 391 1.2.2.2 yamt */ 392 1.2.2.2 yamt if (upgt_fw_load(sc) != 0) 393 1.2.2.2 yamt goto fail; 394 1.2.2.2 yamt 395 1.2.2.2 yamt /* 396 1.2.2.2 yamt * Startup the RX pipe. 397 1.2.2.2 yamt */ 398 1.2.2.2 yamt struct upgt_data *data_rx = &sc->rx_data; 399 1.2.2.2 yamt 400 1.2.2.2 yamt usbd_setup_xfer(data_rx->xfer, sc->sc_rx_pipeh, data_rx, data_rx->buf, 401 1.2.2.2 yamt MCLBYTES, USBD_SHORT_XFER_OK, USBD_NO_TIMEOUT, upgt_rx_cb); 402 1.2.2.2 yamt error = usbd_transfer(data_rx->xfer); 403 1.2.2.2 yamt if (error != USBD_NORMAL_COMPLETION && error != USBD_IN_PROGRESS) { 404 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 405 1.2.2.2 yamt "could not queue RX transfer\n"); 406 1.2.2.2 yamt goto fail; 407 1.2.2.2 yamt } 408 1.2.2.2 yamt usbd_delay_ms(sc->sc_udev, 100); 409 1.2.2.2 yamt 410 1.2.2.2 yamt /* 411 1.2.2.2 yamt * Read the whole EEPROM content and parse it. 412 1.2.2.2 yamt */ 413 1.2.2.2 yamt if (upgt_eeprom_read(sc) != 0) 414 1.2.2.2 yamt goto fail; 415 1.2.2.2 yamt if (upgt_eeprom_parse(sc) != 0) 416 1.2.2.2 yamt goto fail; 417 1.2.2.2 yamt 418 1.2.2.2 yamt /* 419 1.2.2.2 yamt * Setup the 802.11 device. 420 1.2.2.2 yamt */ 421 1.2.2.2 yamt ic->ic_ifp = ifp; 422 1.2.2.2 yamt ic->ic_phytype = IEEE80211_T_OFDM; 423 1.2.2.2 yamt ic->ic_opmode = IEEE80211_M_STA; 424 1.2.2.2 yamt ic->ic_state = IEEE80211_S_INIT; 425 1.2.2.2 yamt ic->ic_caps = 426 1.2.2.2 yamt IEEE80211_C_MONITOR | 427 1.2.2.2 yamt IEEE80211_C_SHPREAMBLE | 428 1.2.2.2 yamt IEEE80211_C_SHSLOT; 429 1.2.2.2 yamt 430 1.2.2.2 yamt ic->ic_sup_rates[IEEE80211_MODE_11B] = ieee80211_std_rateset_11b; 431 1.2.2.2 yamt ic->ic_sup_rates[IEEE80211_MODE_11G] = ieee80211_std_rateset_11g; 432 1.2.2.2 yamt 433 1.2.2.2 yamt for (i = 1; i <= 14; i++) { 434 1.2.2.2 yamt ic->ic_channels[i].ic_freq = 435 1.2.2.2 yamt ieee80211_ieee2mhz(i, IEEE80211_CHAN_2GHZ); 436 1.2.2.2 yamt ic->ic_channels[i].ic_flags = 437 1.2.2.2 yamt IEEE80211_CHAN_CCK | IEEE80211_CHAN_OFDM | 438 1.2.2.2 yamt IEEE80211_CHAN_DYN | IEEE80211_CHAN_2GHZ; 439 1.2.2.2 yamt } 440 1.2.2.2 yamt 441 1.2.2.2 yamt ifp->if_softc = sc; 442 1.2.2.2 yamt ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST; 443 1.2.2.2 yamt ifp->if_init = upgt_init; 444 1.2.2.2 yamt ifp->if_ioctl = upgt_ioctl; 445 1.2.2.2 yamt ifp->if_start = upgt_start; 446 1.2.2.2 yamt ifp->if_watchdog = upgt_watchdog; 447 1.2.2.2 yamt IFQ_SET_READY(&ifp->if_snd); 448 1.2.2.2 yamt memcpy(ifp->if_xname, device_xname(sc->sc_dev), IFNAMSIZ); 449 1.2.2.2 yamt 450 1.2.2.2 yamt if_attach(ifp); 451 1.2.2.2 yamt ieee80211_ifattach(ic); 452 1.2.2.2 yamt ic->ic_newassoc = upgt_newassoc; 453 1.2.2.2 yamt 454 1.2.2.2 yamt sc->sc_newstate = ic->ic_newstate; 455 1.2.2.2 yamt ic->ic_newstate = upgt_newstate; 456 1.2.2.2 yamt ieee80211_media_init(ic, upgt_media_change, ieee80211_media_status); 457 1.2.2.2 yamt 458 1.2.2.2 yamt bpf_attach2(ifp, DLT_IEEE802_11_RADIO, 459 1.2.2.2 yamt sizeof(struct ieee80211_frame) + IEEE80211_RADIOTAP_HDRLEN, 460 1.2.2.2 yamt &sc->sc_drvbpf); 461 1.2.2.2 yamt 462 1.2.2.2 yamt sc->sc_rxtap_len = sizeof(sc->sc_rxtapu); 463 1.2.2.2 yamt sc->sc_rxtap.wr_ihdr.it_len = htole16(sc->sc_rxtap_len); 464 1.2.2.2 yamt sc->sc_rxtap.wr_ihdr.it_present = htole32(UPGT_RX_RADIOTAP_PRESENT); 465 1.2.2.2 yamt 466 1.2.2.2 yamt sc->sc_txtap_len = sizeof(sc->sc_txtapu); 467 1.2.2.2 yamt sc->sc_txtap.wt_ihdr.it_len = htole16(sc->sc_txtap_len); 468 1.2.2.2 yamt sc->sc_txtap.wt_ihdr.it_present = htole32(UPGT_TX_RADIOTAP_PRESENT); 469 1.2.2.2 yamt 470 1.2.2.2 yamt aprint_normal_dev(sc->sc_dev, "address %s\n", 471 1.2.2.2 yamt ether_sprintf(ic->ic_myaddr)); 472 1.2.2.2 yamt 473 1.2.2.2 yamt ieee80211_announce(ic); 474 1.2.2.2 yamt 475 1.2.2.2 yamt usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH, sc->sc_udev, sc->sc_dev); 476 1.2.2.2 yamt 477 1.2.2.2 yamt /* device attached */ 478 1.2.2.2 yamt sc->sc_flags |= UPGT_DEVICE_ATTACHED; 479 1.2.2.2 yamt 480 1.2.2.2 yamt return; 481 1.2.2.2 yamt fail: 482 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, "%s failed\n", __func__); 483 1.2.2.2 yamt } 484 1.2.2.2 yamt 485 1.2.2.2 yamt static int 486 1.2.2.2 yamt upgt_detach(device_t self, int flags) 487 1.2.2.2 yamt { 488 1.2.2.2 yamt struct upgt_softc *sc = device_private(self); 489 1.2.2.2 yamt struct ifnet *ifp = &sc->sc_if; 490 1.2.2.2 yamt struct ieee80211com *ic = &sc->sc_ic; 491 1.2.2.2 yamt int s; 492 1.2.2.2 yamt 493 1.2.2.2 yamt DPRINTF(1, "%s: %s\n", device_xname(sc->sc_dev), __func__); 494 1.2.2.2 yamt 495 1.2.2.2 yamt s = splnet(); 496 1.2.2.2 yamt 497 1.2.2.2 yamt if (ifp->if_flags & IFF_RUNNING) 498 1.2.2.2 yamt upgt_stop(sc); 499 1.2.2.2 yamt 500 1.2.2.2 yamt /* remove tasks and timeouts */ 501 1.2.2.2 yamt usb_rem_task(sc->sc_udev, &sc->sc_task_newstate); 502 1.2.2.2 yamt usb_rem_task(sc->sc_udev, &sc->sc_task_tx); 503 1.2.2.2 yamt callout_destroy(&sc->scan_to); 504 1.2.2.2 yamt callout_destroy(&sc->led_to); 505 1.2.2.2 yamt 506 1.2.2.2 yamt /* abort and close TX / RX pipes */ 507 1.2.2.2 yamt if (sc->sc_tx_pipeh != NULL) { 508 1.2.2.2 yamt usbd_abort_pipe(sc->sc_tx_pipeh); 509 1.2.2.2 yamt usbd_close_pipe(sc->sc_tx_pipeh); 510 1.2.2.2 yamt } 511 1.2.2.2 yamt if (sc->sc_rx_pipeh != NULL) { 512 1.2.2.2 yamt usbd_abort_pipe(sc->sc_rx_pipeh); 513 1.2.2.2 yamt usbd_close_pipe(sc->sc_rx_pipeh); 514 1.2.2.2 yamt } 515 1.2.2.2 yamt 516 1.2.2.2 yamt /* free xfers */ 517 1.2.2.2 yamt upgt_free_tx(sc); 518 1.2.2.2 yamt upgt_free_rx(sc); 519 1.2.2.2 yamt upgt_free_cmd(sc); 520 1.2.2.2 yamt 521 1.2.2.2 yamt /* free firmware */ 522 1.2.2.2 yamt upgt_fw_free(sc); 523 1.2.2.2 yamt 524 1.2.2.2 yamt if (sc->sc_flags & UPGT_DEVICE_ATTACHED) { 525 1.2.2.2 yamt /* detach interface */ 526 1.2.2.2 yamt bpf_detach(ifp); 527 1.2.2.2 yamt ieee80211_ifdetach(ic); 528 1.2.2.2 yamt if_detach(ifp); 529 1.2.2.2 yamt } 530 1.2.2.2 yamt 531 1.2.2.2 yamt splx(s); 532 1.2.2.2 yamt 533 1.2.2.2 yamt usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev, sc->sc_dev); 534 1.2.2.2 yamt 535 1.2.2.2 yamt return 0; 536 1.2.2.2 yamt } 537 1.2.2.2 yamt 538 1.2.2.2 yamt static int 539 1.2.2.2 yamt upgt_activate(device_t self, devact_t act) 540 1.2.2.2 yamt { 541 1.2.2.2 yamt struct upgt_softc *sc = device_private(self); 542 1.2.2.2 yamt 543 1.2.2.2 yamt switch (act) { 544 1.2.2.2 yamt case DVACT_DEACTIVATE: 545 1.2.2.2 yamt if_deactivate(&sc->sc_if); 546 1.2.2.2 yamt return 0; 547 1.2.2.2 yamt default: 548 1.2.2.2 yamt return EOPNOTSUPP; 549 1.2.2.2 yamt } 550 1.2.2.2 yamt } 551 1.2.2.2 yamt 552 1.2.2.2 yamt static int 553 1.2.2.2 yamt upgt_device_type(struct upgt_softc *sc, uint16_t vendor, uint16_t product) 554 1.2.2.2 yamt { 555 1.2.2.2 yamt 556 1.2.2.2 yamt if (usb_lookup(upgt_devs_1, vendor, product) != NULL) { 557 1.2.2.2 yamt sc->sc_device_type = 1; 558 1.2.2.2 yamt /* XXX */ 559 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 560 1.2.2.2 yamt "version 1 devices not supported yet\n"); 561 1.2.2.2 yamt return 1; 562 1.2.2.2 yamt } else 563 1.2.2.2 yamt sc->sc_device_type = 2; 564 1.2.2.2 yamt 565 1.2.2.2 yamt return 0; 566 1.2.2.2 yamt } 567 1.2.2.2 yamt 568 1.2.2.2 yamt static int 569 1.2.2.2 yamt upgt_device_init(struct upgt_softc *sc) 570 1.2.2.2 yamt { 571 1.2.2.2 yamt struct upgt_data *data_cmd = &sc->cmd_data; 572 1.2.2.2 yamt const uint8_t init_cmd[] = { 0x7e, 0x7e, 0x7e, 0x7e }; 573 1.2.2.2 yamt int len; 574 1.2.2.2 yamt 575 1.2.2.2 yamt len = sizeof(init_cmd); 576 1.2.2.2 yamt memcpy(data_cmd->buf, init_cmd, len); 577 1.2.2.2 yamt if (upgt_bulk_xmit(sc, data_cmd, sc->sc_tx_pipeh, &len, 0) != 0) { 578 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 579 1.2.2.2 yamt "could not send device init string\n"); 580 1.2.2.2 yamt return EIO; 581 1.2.2.2 yamt } 582 1.2.2.2 yamt usbd_delay_ms(sc->sc_udev, 100); 583 1.2.2.2 yamt 584 1.2.2.2 yamt DPRINTF(1, "%s: device initialized\n", device_xname(sc->sc_dev)); 585 1.2.2.2 yamt 586 1.2.2.2 yamt return 0; 587 1.2.2.2 yamt } 588 1.2.2.2 yamt 589 1.2.2.2 yamt static int 590 1.2.2.2 yamt upgt_mem_init(struct upgt_softc *sc) 591 1.2.2.2 yamt { 592 1.2.2.2 yamt int i; 593 1.2.2.2 yamt 594 1.2.2.2 yamt for (i = 0; i < UPGT_MEMORY_MAX_PAGES; i++) { 595 1.2.2.2 yamt sc->sc_memory.page[i].used = 0; 596 1.2.2.2 yamt 597 1.2.2.2 yamt if (i == 0) { 598 1.2.2.2 yamt /* 599 1.2.2.2 yamt * The first memory page is always reserved for 600 1.2.2.2 yamt * command data. 601 1.2.2.2 yamt */ 602 1.2.2.2 yamt sc->sc_memory.page[i].addr = 603 1.2.2.2 yamt sc->sc_memaddr_frame_start + MCLBYTES; 604 1.2.2.2 yamt } else { 605 1.2.2.2 yamt sc->sc_memory.page[i].addr = 606 1.2.2.2 yamt sc->sc_memory.page[i - 1].addr + MCLBYTES; 607 1.2.2.2 yamt } 608 1.2.2.2 yamt 609 1.2.2.2 yamt if (sc->sc_memory.page[i].addr + MCLBYTES >= 610 1.2.2.2 yamt sc->sc_memaddr_frame_end) 611 1.2.2.2 yamt break; 612 1.2.2.2 yamt 613 1.2.2.2 yamt DPRINTF(2, "%s: memory address page %d=0x%08x\n", 614 1.2.2.2 yamt device_xname(sc->sc_dev), i, sc->sc_memory.page[i].addr); 615 1.2.2.2 yamt } 616 1.2.2.2 yamt 617 1.2.2.2 yamt sc->sc_memory.pages = i; 618 1.2.2.2 yamt 619 1.2.2.2 yamt DPRINTF(2, "%s: memory pages=%d\n", 620 1.2.2.2 yamt device_xname(sc->sc_dev), sc->sc_memory.pages); 621 1.2.2.2 yamt 622 1.2.2.2 yamt return 0; 623 1.2.2.2 yamt } 624 1.2.2.2 yamt 625 1.2.2.2 yamt static uint32_t 626 1.2.2.2 yamt upgt_mem_alloc(struct upgt_softc *sc) 627 1.2.2.2 yamt { 628 1.2.2.2 yamt int i; 629 1.2.2.2 yamt 630 1.2.2.2 yamt for (i = 0; i < sc->sc_memory.pages; i++) { 631 1.2.2.2 yamt if (sc->sc_memory.page[i].used == 0) { 632 1.2.2.2 yamt sc->sc_memory.page[i].used = 1; 633 1.2.2.2 yamt return sc->sc_memory.page[i].addr; 634 1.2.2.2 yamt } 635 1.2.2.2 yamt } 636 1.2.2.2 yamt 637 1.2.2.2 yamt return 0; 638 1.2.2.2 yamt } 639 1.2.2.2 yamt 640 1.2.2.2 yamt static void 641 1.2.2.2 yamt upgt_mem_free(struct upgt_softc *sc, uint32_t addr) 642 1.2.2.2 yamt { 643 1.2.2.2 yamt int i; 644 1.2.2.2 yamt 645 1.2.2.2 yamt for (i = 0; i < sc->sc_memory.pages; i++) { 646 1.2.2.2 yamt if (sc->sc_memory.page[i].addr == addr) { 647 1.2.2.2 yamt sc->sc_memory.page[i].used = 0; 648 1.2.2.2 yamt return; 649 1.2.2.2 yamt } 650 1.2.2.2 yamt } 651 1.2.2.2 yamt 652 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, "could not free memory address 0x%08x\n", 653 1.2.2.2 yamt addr); 654 1.2.2.2 yamt } 655 1.2.2.2 yamt 656 1.2.2.2 yamt 657 1.2.2.2 yamt static int 658 1.2.2.2 yamt upgt_fw_alloc(struct upgt_softc *sc) 659 1.2.2.2 yamt { 660 1.2.2.2 yamt const char *name = "upgt-gw3887"; 661 1.2.2.2 yamt int error; 662 1.2.2.2 yamt 663 1.2.2.2 yamt if (sc->sc_fw == NULL) { 664 1.2.2.2 yamt error = firmware_load("upgt", name, &sc->sc_fw, 665 1.2.2.2 yamt &sc->sc_fw_size); 666 1.2.2.2 yamt if (error != 0) { 667 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 668 1.2.2.2 yamt "could not read firmware %s\n", name); 669 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 670 1.2.2.2 yamt "see upgt(4) man page for details\n"); 671 1.2.2.2 yamt return EIO; 672 1.2.2.2 yamt } 673 1.2.2.2 yamt } 674 1.2.2.2 yamt 675 1.2.2.2 yamt DPRINTF(1, "%s: firmware %s allocated\n", device_xname(sc->sc_dev), 676 1.2.2.2 yamt name); 677 1.2.2.2 yamt 678 1.2.2.2 yamt return 0; 679 1.2.2.2 yamt } 680 1.2.2.2 yamt 681 1.2.2.2 yamt static void 682 1.2.2.2 yamt upgt_fw_free(struct upgt_softc *sc) 683 1.2.2.2 yamt { 684 1.2.2.2 yamt 685 1.2.2.2 yamt if (sc->sc_fw != NULL) { 686 1.2.2.2 yamt firmware_free(sc->sc_fw, sc->sc_fw_size); 687 1.2.2.2 yamt sc->sc_fw = NULL; 688 1.2.2.2 yamt DPRINTF(1, "%s: firmware freed\n", device_xname(sc->sc_dev)); 689 1.2.2.2 yamt } 690 1.2.2.2 yamt } 691 1.2.2.2 yamt 692 1.2.2.2 yamt static int 693 1.2.2.2 yamt upgt_fw_verify(struct upgt_softc *sc) 694 1.2.2.2 yamt { 695 1.2.2.2 yamt struct upgt_fw_bra_option *bra_option; 696 1.2.2.2 yamt uint32_t bra_option_type, bra_option_len; 697 1.2.2.2 yamt uint32_t *uc; 698 1.2.2.2 yamt int offset, bra_end = 0; 699 1.2.2.2 yamt 700 1.2.2.2 yamt /* 701 1.2.2.2 yamt * Seek to beginning of Boot Record Area (BRA). 702 1.2.2.2 yamt */ 703 1.2.2.2 yamt for (offset = 0; offset < sc->sc_fw_size; offset += sizeof(*uc)) { 704 1.2.2.2 yamt uc = (uint32_t *)(sc->sc_fw + offset); 705 1.2.2.2 yamt if (*uc == 0) 706 1.2.2.2 yamt break; 707 1.2.2.2 yamt } 708 1.2.2.2 yamt for (; offset < sc->sc_fw_size; offset += sizeof(*uc)) { 709 1.2.2.2 yamt uc = (uint32_t *)(sc->sc_fw + offset); 710 1.2.2.2 yamt if (*uc != 0) 711 1.2.2.2 yamt break; 712 1.2.2.2 yamt } 713 1.2.2.2 yamt if (offset == sc->sc_fw_size) { 714 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 715 1.2.2.2 yamt "firmware Boot Record Area not found\n"); 716 1.2.2.2 yamt return EIO; 717 1.2.2.2 yamt } 718 1.2.2.2 yamt DPRINTF(1, "%s: firmware Boot Record Area found at offset %d\n", 719 1.2.2.2 yamt device_xname(sc->sc_dev), offset); 720 1.2.2.2 yamt 721 1.2.2.2 yamt /* 722 1.2.2.2 yamt * Parse Boot Record Area (BRA) options. 723 1.2.2.2 yamt */ 724 1.2.2.2 yamt while (offset < sc->sc_fw_size && bra_end == 0) { 725 1.2.2.2 yamt /* get current BRA option */ 726 1.2.2.2 yamt bra_option = (struct upgt_fw_bra_option *)(sc->sc_fw + offset); 727 1.2.2.2 yamt bra_option_type = le32toh(bra_option->type); 728 1.2.2.2 yamt bra_option_len = le32toh(bra_option->len) * sizeof(*uc); 729 1.2.2.2 yamt 730 1.2.2.2 yamt switch (bra_option_type) { 731 1.2.2.2 yamt case UPGT_BRA_TYPE_FW: 732 1.2.2.2 yamt DPRINTF(1, "%s: UPGT_BRA_TYPE_FW len=%d\n", 733 1.2.2.2 yamt device_xname(sc->sc_dev), bra_option_len); 734 1.2.2.2 yamt 735 1.2.2.2 yamt if (bra_option_len != UPGT_BRA_FWTYPE_SIZE) { 736 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 737 1.2.2.2 yamt "wrong UPGT_BRA_TYPE_FW len\n"); 738 1.2.2.2 yamt return EIO; 739 1.2.2.2 yamt } 740 1.2.2.2 yamt if (memcmp(UPGT_BRA_FWTYPE_LM86, bra_option->data, 741 1.2.2.2 yamt bra_option_len) == 0) { 742 1.2.2.2 yamt sc->sc_fw_type = UPGT_FWTYPE_LM86; 743 1.2.2.2 yamt break; 744 1.2.2.2 yamt } 745 1.2.2.2 yamt if (memcmp(UPGT_BRA_FWTYPE_LM87, bra_option->data, 746 1.2.2.2 yamt bra_option_len) == 0) { 747 1.2.2.2 yamt sc->sc_fw_type = UPGT_FWTYPE_LM87; 748 1.2.2.2 yamt break; 749 1.2.2.2 yamt } 750 1.2.2.2 yamt if (memcmp(UPGT_BRA_FWTYPE_FMAC, bra_option->data, 751 1.2.2.2 yamt bra_option_len) == 0) { 752 1.2.2.2 yamt sc->sc_fw_type = UPGT_FWTYPE_FMAC; 753 1.2.2.2 yamt break; 754 1.2.2.2 yamt } 755 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 756 1.2.2.2 yamt "unsupported firmware type\n"); 757 1.2.2.2 yamt return EIO; 758 1.2.2.2 yamt case UPGT_BRA_TYPE_VERSION: 759 1.2.2.2 yamt DPRINTF(1, "%s: UPGT_BRA_TYPE_VERSION len=%d\n", 760 1.2.2.2 yamt device_xname(sc->sc_dev), bra_option_len); 761 1.2.2.2 yamt break; 762 1.2.2.2 yamt case UPGT_BRA_TYPE_DEPIF: 763 1.2.2.2 yamt DPRINTF(1, "%s: UPGT_BRA_TYPE_DEPIF len=%d\n", 764 1.2.2.2 yamt device_xname(sc->sc_dev), bra_option_len); 765 1.2.2.2 yamt break; 766 1.2.2.2 yamt case UPGT_BRA_TYPE_EXPIF: 767 1.2.2.2 yamt DPRINTF(1, "%s: UPGT_BRA_TYPE_EXPIF len=%d\n", 768 1.2.2.2 yamt device_xname(sc->sc_dev), bra_option_len); 769 1.2.2.2 yamt break; 770 1.2.2.2 yamt case UPGT_BRA_TYPE_DESCR: 771 1.2.2.2 yamt DPRINTF(1, "%s: UPGT_BRA_TYPE_DESCR len=%d\n", 772 1.2.2.2 yamt device_xname(sc->sc_dev), bra_option_len); 773 1.2.2.2 yamt 774 1.2.2.2 yamt struct upgt_fw_bra_descr *descr = 775 1.2.2.2 yamt (struct upgt_fw_bra_descr *)bra_option->data; 776 1.2.2.2 yamt 777 1.2.2.2 yamt sc->sc_memaddr_frame_start = 778 1.2.2.2 yamt le32toh(descr->memaddr_space_start); 779 1.2.2.2 yamt sc->sc_memaddr_frame_end = 780 1.2.2.2 yamt le32toh(descr->memaddr_space_end); 781 1.2.2.2 yamt 782 1.2.2.2 yamt DPRINTF(2, "%s: memory address space start=0x%08x\n", 783 1.2.2.2 yamt device_xname(sc->sc_dev), 784 1.2.2.2 yamt sc->sc_memaddr_frame_start); 785 1.2.2.2 yamt DPRINTF(2, "%s: memory address space end=0x%08x\n", 786 1.2.2.2 yamt device_xname(sc->sc_dev), 787 1.2.2.2 yamt sc->sc_memaddr_frame_end); 788 1.2.2.2 yamt break; 789 1.2.2.2 yamt case UPGT_BRA_TYPE_END: 790 1.2.2.2 yamt DPRINTF(1, "%s: UPGT_BRA_TYPE_END len=%d\n", 791 1.2.2.2 yamt device_xname(sc->sc_dev), bra_option_len); 792 1.2.2.2 yamt bra_end = 1; 793 1.2.2.2 yamt break; 794 1.2.2.2 yamt default: 795 1.2.2.2 yamt DPRINTF(1, "%s: unknown BRA option len=%d\n", 796 1.2.2.2 yamt device_xname(sc->sc_dev), bra_option_len); 797 1.2.2.2 yamt return EIO; 798 1.2.2.2 yamt } 799 1.2.2.2 yamt 800 1.2.2.2 yamt /* jump to next BRA option */ 801 1.2.2.2 yamt offset += sizeof(struct upgt_fw_bra_option) + bra_option_len; 802 1.2.2.2 yamt } 803 1.2.2.2 yamt 804 1.2.2.2 yamt DPRINTF(1, "%s: firmware verified\n", device_xname(sc->sc_dev)); 805 1.2.2.2 yamt 806 1.2.2.2 yamt return 0; 807 1.2.2.2 yamt } 808 1.2.2.2 yamt 809 1.2.2.2 yamt static int 810 1.2.2.2 yamt upgt_fw_load(struct upgt_softc *sc) 811 1.2.2.2 yamt { 812 1.2.2.2 yamt struct upgt_data *data_cmd = &sc->cmd_data; 813 1.2.2.2 yamt struct upgt_data *data_rx = &sc->rx_data; 814 1.2.2.2 yamt struct upgt_fw_x2_header *x2; 815 1.2.2.2 yamt const uint8_t start_fwload_cmd[] = { 0x3c, 0x0d }; 816 1.2.2.2 yamt int offset, bsize, n, i, len; 817 1.2.2.2 yamt uint32_t crc; 818 1.2.2.2 yamt 819 1.2.2.2 yamt /* send firmware start load command */ 820 1.2.2.2 yamt len = sizeof(start_fwload_cmd); 821 1.2.2.2 yamt memcpy(data_cmd->buf, start_fwload_cmd, len); 822 1.2.2.2 yamt if (upgt_bulk_xmit(sc, data_cmd, sc->sc_tx_pipeh, &len, 0) != 0) { 823 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 824 1.2.2.2 yamt "could not send start_firmware_load command\n"); 825 1.2.2.2 yamt return EIO; 826 1.2.2.2 yamt } 827 1.2.2.2 yamt 828 1.2.2.2 yamt /* send X2 header */ 829 1.2.2.2 yamt len = sizeof(struct upgt_fw_x2_header); 830 1.2.2.2 yamt x2 = (struct upgt_fw_x2_header *)data_cmd->buf; 831 1.2.2.2 yamt memcpy(x2->signature, UPGT_X2_SIGNATURE, UPGT_X2_SIGNATURE_SIZE); 832 1.2.2.2 yamt x2->startaddr = htole32(UPGT_MEMADDR_FIRMWARE_START); 833 1.2.2.2 yamt x2->len = htole32(sc->sc_fw_size); 834 1.2.2.2 yamt x2->crc = upgt_crc32_le(data_cmd->buf + UPGT_X2_SIGNATURE_SIZE, 835 1.2.2.2 yamt sizeof(struct upgt_fw_x2_header) - UPGT_X2_SIGNATURE_SIZE - 836 1.2.2.2 yamt sizeof(uint32_t)); 837 1.2.2.2 yamt if (upgt_bulk_xmit(sc, data_cmd, sc->sc_tx_pipeh, &len, 0) != 0) { 838 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 839 1.2.2.2 yamt "could not send firmware X2 header\n"); 840 1.2.2.2 yamt return EIO; 841 1.2.2.2 yamt } 842 1.2.2.2 yamt 843 1.2.2.2 yamt /* download firmware */ 844 1.2.2.2 yamt for (offset = 0; offset < sc->sc_fw_size; offset += bsize) { 845 1.2.2.2 yamt if (sc->sc_fw_size - offset > UPGT_FW_BLOCK_SIZE) 846 1.2.2.2 yamt bsize = UPGT_FW_BLOCK_SIZE; 847 1.2.2.2 yamt else 848 1.2.2.2 yamt bsize = sc->sc_fw_size - offset; 849 1.2.2.2 yamt 850 1.2.2.2 yamt n = upgt_fw_copy(sc->sc_fw + offset, data_cmd->buf, bsize); 851 1.2.2.2 yamt 852 1.2.2.2 yamt DPRINTF(1, "%s: FW offset=%d, read=%d, sent=%d\n", 853 1.2.2.2 yamt device_xname(sc->sc_dev), offset, n, bsize); 854 1.2.2.2 yamt 855 1.2.2.2 yamt if (upgt_bulk_xmit(sc, data_cmd, sc->sc_tx_pipeh, &bsize, 0) 856 1.2.2.2 yamt != 0) { 857 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 858 1.2.2.2 yamt "error while downloading firmware block\n"); 859 1.2.2.2 yamt return EIO; 860 1.2.2.2 yamt } 861 1.2.2.2 yamt 862 1.2.2.2 yamt bsize = n; 863 1.2.2.2 yamt } 864 1.2.2.2 yamt DPRINTF(1, "%s: firmware downloaded\n", device_xname(sc->sc_dev)); 865 1.2.2.2 yamt 866 1.2.2.2 yamt /* load firmware */ 867 1.2.2.2 yamt crc = upgt_crc32_le(sc->sc_fw, sc->sc_fw_size); 868 1.2.2.2 yamt *((uint32_t *)(data_cmd->buf) ) = crc; 869 1.2.2.2 yamt *((uint8_t *)(data_cmd->buf) + 4) = 'g'; 870 1.2.2.2 yamt *((uint8_t *)(data_cmd->buf) + 5) = '\r'; 871 1.2.2.2 yamt len = 6; 872 1.2.2.2 yamt if (upgt_bulk_xmit(sc, data_cmd, sc->sc_tx_pipeh, &len, 0) != 0) { 873 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 874 1.2.2.2 yamt "could not send load_firmware command\n"); 875 1.2.2.2 yamt return EIO; 876 1.2.2.2 yamt } 877 1.2.2.2 yamt 878 1.2.2.2 yamt for (i = 0; i < UPGT_FIRMWARE_TIMEOUT; i++) { 879 1.2.2.2 yamt len = UPGT_FW_BLOCK_SIZE; 880 1.2.2.2 yamt memset(data_rx->buf, 0, 2); 881 1.2.2.2 yamt if (upgt_bulk_xmit(sc, data_rx, sc->sc_rx_pipeh, &len, 882 1.2.2.2 yamt USBD_SHORT_XFER_OK) != 0) { 883 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 884 1.2.2.2 yamt "could not read firmware response\n"); 885 1.2.2.2 yamt return EIO; 886 1.2.2.2 yamt } 887 1.2.2.2 yamt 888 1.2.2.2 yamt if (memcmp(data_rx->buf, "OK", 2) == 0) 889 1.2.2.2 yamt break; /* firmware load was successful */ 890 1.2.2.2 yamt } 891 1.2.2.2 yamt if (i == UPGT_FIRMWARE_TIMEOUT) { 892 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, "firmware load failed\n"); 893 1.2.2.2 yamt return EIO; 894 1.2.2.2 yamt } 895 1.2.2.2 yamt DPRINTF(1, "%s: firmware loaded\n", device_xname(sc->sc_dev)); 896 1.2.2.2 yamt 897 1.2.2.2 yamt return 0; 898 1.2.2.2 yamt } 899 1.2.2.2 yamt 900 1.2.2.2 yamt /* 901 1.2.2.2 yamt * While copying the version 2 firmware, we need to replace two characters: 902 1.2.2.2 yamt * 903 1.2.2.2 yamt * 0x7e -> 0x7d 0x5e 904 1.2.2.2 yamt * 0x7d -> 0x7d 0x5d 905 1.2.2.2 yamt */ 906 1.2.2.2 yamt static int 907 1.2.2.2 yamt upgt_fw_copy(char *src, char *dst, int size) 908 1.2.2.2 yamt { 909 1.2.2.2 yamt int i, j; 910 1.2.2.2 yamt 911 1.2.2.2 yamt for (i = 0, j = 0; i < size && j < size; i++) { 912 1.2.2.2 yamt switch (src[i]) { 913 1.2.2.2 yamt case 0x7e: 914 1.2.2.2 yamt dst[j] = 0x7d; 915 1.2.2.2 yamt j++; 916 1.2.2.2 yamt dst[j] = 0x5e; 917 1.2.2.2 yamt j++; 918 1.2.2.2 yamt break; 919 1.2.2.2 yamt case 0x7d: 920 1.2.2.2 yamt dst[j] = 0x7d; 921 1.2.2.2 yamt j++; 922 1.2.2.2 yamt dst[j] = 0x5d; 923 1.2.2.2 yamt j++; 924 1.2.2.2 yamt break; 925 1.2.2.2 yamt default: 926 1.2.2.2 yamt dst[j] = src[i]; 927 1.2.2.2 yamt j++; 928 1.2.2.2 yamt break; 929 1.2.2.2 yamt } 930 1.2.2.2 yamt } 931 1.2.2.2 yamt 932 1.2.2.2 yamt return i; 933 1.2.2.2 yamt } 934 1.2.2.2 yamt 935 1.2.2.2 yamt static int 936 1.2.2.2 yamt upgt_eeprom_read(struct upgt_softc *sc) 937 1.2.2.2 yamt { 938 1.2.2.2 yamt struct upgt_data *data_cmd = &sc->cmd_data; 939 1.2.2.2 yamt struct upgt_lmac_mem *mem; 940 1.2.2.2 yamt struct upgt_lmac_eeprom *eeprom; 941 1.2.2.2 yamt int offset, block, len; 942 1.2.2.2 yamt 943 1.2.2.2 yamt offset = 0; 944 1.2.2.2 yamt block = UPGT_EEPROM_BLOCK_SIZE; 945 1.2.2.2 yamt while (offset < UPGT_EEPROM_SIZE) { 946 1.2.2.2 yamt DPRINTF(1, "%s: request EEPROM block (offset=%d, len=%d)\n", 947 1.2.2.2 yamt device_xname(sc->sc_dev), offset, block); 948 1.2.2.2 yamt 949 1.2.2.2 yamt /* 950 1.2.2.2 yamt * Transmit the URB containing the CMD data. 951 1.2.2.2 yamt */ 952 1.2.2.2 yamt len = sizeof(*mem) + sizeof(*eeprom) + block; 953 1.2.2.2 yamt 954 1.2.2.2 yamt memset(data_cmd->buf, 0, len); 955 1.2.2.2 yamt 956 1.2.2.2 yamt mem = (struct upgt_lmac_mem *)data_cmd->buf; 957 1.2.2.2 yamt mem->addr = htole32(sc->sc_memaddr_frame_start + 958 1.2.2.2 yamt UPGT_MEMSIZE_FRAME_HEAD); 959 1.2.2.2 yamt 960 1.2.2.2 yamt eeprom = (struct upgt_lmac_eeprom *)(mem + 1); 961 1.2.2.2 yamt eeprom->header1.flags = 0; 962 1.2.2.2 yamt eeprom->header1.type = UPGT_H1_TYPE_CTRL; 963 1.2.2.2 yamt eeprom->header1.len = htole16(( 964 1.2.2.2 yamt sizeof(struct upgt_lmac_eeprom) - 965 1.2.2.2 yamt sizeof(struct upgt_lmac_header)) + block); 966 1.2.2.2 yamt 967 1.2.2.2 yamt eeprom->header2.reqid = htole32(sc->sc_memaddr_frame_start); 968 1.2.2.2 yamt eeprom->header2.type = htole16(UPGT_H2_TYPE_EEPROM); 969 1.2.2.2 yamt eeprom->header2.flags = 0; 970 1.2.2.2 yamt 971 1.2.2.2 yamt eeprom->offset = htole16(offset); 972 1.2.2.2 yamt eeprom->len = htole16(block); 973 1.2.2.2 yamt 974 1.2.2.2 yamt mem->chksum = upgt_chksum_le((uint32_t *)eeprom, 975 1.2.2.2 yamt len - sizeof(*mem)); 976 1.2.2.2 yamt 977 1.2.2.2 yamt if (upgt_bulk_xmit(sc, data_cmd, sc->sc_tx_pipeh, &len, 978 1.2.2.2 yamt USBD_FORCE_SHORT_XFER) != 0) { 979 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 980 1.2.2.2 yamt "could not transmit EEPROM data URB\n"); 981 1.2.2.2 yamt return EIO; 982 1.2.2.2 yamt } 983 1.2.2.2 yamt if (tsleep(sc, 0, "eeprom_request", UPGT_USB_TIMEOUT)) { 984 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 985 1.2.2.2 yamt "timeout while waiting for EEPROM data\n"); 986 1.2.2.2 yamt return EIO; 987 1.2.2.2 yamt } 988 1.2.2.2 yamt 989 1.2.2.2 yamt offset += block; 990 1.2.2.2 yamt if (UPGT_EEPROM_SIZE - offset < block) 991 1.2.2.2 yamt block = UPGT_EEPROM_SIZE - offset; 992 1.2.2.2 yamt } 993 1.2.2.2 yamt 994 1.2.2.2 yamt return 0; 995 1.2.2.2 yamt } 996 1.2.2.2 yamt 997 1.2.2.2 yamt static int 998 1.2.2.2 yamt upgt_eeprom_parse(struct upgt_softc *sc) 999 1.2.2.2 yamt { 1000 1.2.2.2 yamt struct ieee80211com *ic = &sc->sc_ic; 1001 1.2.2.2 yamt struct upgt_eeprom_header *eeprom_header; 1002 1.2.2.2 yamt struct upgt_eeprom_option *eeprom_option; 1003 1.2.2.2 yamt uint16_t option_len; 1004 1.2.2.2 yamt uint16_t option_type; 1005 1.2.2.2 yamt uint16_t preamble_len; 1006 1.2.2.2 yamt int option_end = 0; 1007 1.2.2.2 yamt 1008 1.2.2.2 yamt /* calculate eeprom options start offset */ 1009 1.2.2.2 yamt eeprom_header = (struct upgt_eeprom_header *)sc->sc_eeprom; 1010 1.2.2.2 yamt preamble_len = le16toh(eeprom_header->preamble_len); 1011 1.2.2.2 yamt eeprom_option = (struct upgt_eeprom_option *)(sc->sc_eeprom + 1012 1.2.2.2 yamt (sizeof(struct upgt_eeprom_header) + preamble_len)); 1013 1.2.2.2 yamt 1014 1.2.2.2 yamt while (!option_end) { 1015 1.2.2.2 yamt /* the eeprom option length is stored in words */ 1016 1.2.2.2 yamt option_len = 1017 1.2.2.2 yamt (le16toh(eeprom_option->len) - 1) * sizeof(uint16_t); 1018 1.2.2.2 yamt option_type = 1019 1.2.2.2 yamt le16toh(eeprom_option->type); 1020 1.2.2.2 yamt 1021 1.2.2.2 yamt switch (option_type) { 1022 1.2.2.2 yamt case UPGT_EEPROM_TYPE_NAME: 1023 1.2.2.2 yamt DPRINTF(1, "%s: EEPROM name len=%d\n", 1024 1.2.2.2 yamt device_xname(sc->sc_dev), option_len); 1025 1.2.2.2 yamt break; 1026 1.2.2.2 yamt case UPGT_EEPROM_TYPE_SERIAL: 1027 1.2.2.2 yamt DPRINTF(1, "%s: EEPROM serial len=%d\n", 1028 1.2.2.2 yamt device_xname(sc->sc_dev), option_len); 1029 1.2.2.2 yamt break; 1030 1.2.2.2 yamt case UPGT_EEPROM_TYPE_MAC: 1031 1.2.2.2 yamt DPRINTF(1, "%s: EEPROM mac len=%d\n", 1032 1.2.2.2 yamt device_xname(sc->sc_dev), option_len); 1033 1.2.2.2 yamt 1034 1.2.2.2 yamt IEEE80211_ADDR_COPY(ic->ic_myaddr, eeprom_option->data); 1035 1.2.2.2 yamt break; 1036 1.2.2.2 yamt case UPGT_EEPROM_TYPE_HWRX: 1037 1.2.2.2 yamt DPRINTF(1, "%s: EEPROM hwrx len=%d\n", 1038 1.2.2.2 yamt device_xname(sc->sc_dev), option_len); 1039 1.2.2.2 yamt 1040 1.2.2.2 yamt upgt_eeprom_parse_hwrx(sc, eeprom_option->data); 1041 1.2.2.2 yamt break; 1042 1.2.2.2 yamt case UPGT_EEPROM_TYPE_CHIP: 1043 1.2.2.2 yamt DPRINTF(1, "%s: EEPROM chip len=%d\n", 1044 1.2.2.2 yamt device_xname(sc->sc_dev), option_len); 1045 1.2.2.2 yamt break; 1046 1.2.2.2 yamt case UPGT_EEPROM_TYPE_FREQ3: 1047 1.2.2.2 yamt DPRINTF(1, "%s: EEPROM freq3 len=%d\n", 1048 1.2.2.2 yamt device_xname(sc->sc_dev), option_len); 1049 1.2.2.2 yamt 1050 1.2.2.2 yamt upgt_eeprom_parse_freq3(sc, eeprom_option->data, 1051 1.2.2.2 yamt option_len); 1052 1.2.2.2 yamt break; 1053 1.2.2.2 yamt case UPGT_EEPROM_TYPE_FREQ4: 1054 1.2.2.2 yamt DPRINTF(1, "%s: EEPROM freq4 len=%d\n", 1055 1.2.2.2 yamt device_xname(sc->sc_dev), option_len); 1056 1.2.2.2 yamt 1057 1.2.2.2 yamt upgt_eeprom_parse_freq4(sc, eeprom_option->data, 1058 1.2.2.2 yamt option_len); 1059 1.2.2.2 yamt break; 1060 1.2.2.2 yamt case UPGT_EEPROM_TYPE_FREQ5: 1061 1.2.2.2 yamt DPRINTF(1, "%s: EEPROM freq5 len=%d\n", 1062 1.2.2.2 yamt device_xname(sc->sc_dev), option_len); 1063 1.2.2.2 yamt break; 1064 1.2.2.2 yamt case UPGT_EEPROM_TYPE_FREQ6: 1065 1.2.2.2 yamt DPRINTF(1, "%s: EEPROM freq6 len=%d\n", 1066 1.2.2.2 yamt device_xname(sc->sc_dev), option_len); 1067 1.2.2.2 yamt 1068 1.2.2.2 yamt upgt_eeprom_parse_freq6(sc, eeprom_option->data, 1069 1.2.2.2 yamt option_len); 1070 1.2.2.2 yamt break; 1071 1.2.2.2 yamt case UPGT_EEPROM_TYPE_END: 1072 1.2.2.2 yamt DPRINTF(1, "%s: EEPROM end len=%d\n", 1073 1.2.2.2 yamt device_xname(sc->sc_dev), option_len); 1074 1.2.2.2 yamt option_end = 1; 1075 1.2.2.2 yamt break; 1076 1.2.2.2 yamt case UPGT_EEPROM_TYPE_OFF: 1077 1.2.2.2 yamt DPRINTF(1, "%s: EEPROM off without end option\n", 1078 1.2.2.2 yamt device_xname(sc->sc_dev)); 1079 1.2.2.2 yamt return EIO; 1080 1.2.2.2 yamt default: 1081 1.2.2.2 yamt DPRINTF(1, "%s: EEPROM unknown type 0x%04x len=%d\n", 1082 1.2.2.2 yamt device_xname(sc->sc_dev), option_type, option_len); 1083 1.2.2.2 yamt break; 1084 1.2.2.2 yamt } 1085 1.2.2.2 yamt 1086 1.2.2.2 yamt /* jump to next EEPROM option */ 1087 1.2.2.2 yamt eeprom_option = (struct upgt_eeprom_option *) 1088 1.2.2.2 yamt (eeprom_option->data + option_len); 1089 1.2.2.2 yamt } 1090 1.2.2.2 yamt 1091 1.2.2.2 yamt return 0; 1092 1.2.2.2 yamt } 1093 1.2.2.2 yamt 1094 1.2.2.2 yamt static void 1095 1.2.2.2 yamt upgt_eeprom_parse_hwrx(struct upgt_softc *sc, uint8_t *data) 1096 1.2.2.2 yamt { 1097 1.2.2.2 yamt struct upgt_eeprom_option_hwrx *option_hwrx; 1098 1.2.2.2 yamt 1099 1.2.2.2 yamt option_hwrx = (struct upgt_eeprom_option_hwrx *)data; 1100 1.2.2.2 yamt 1101 1.2.2.2 yamt sc->sc_eeprom_hwrx = option_hwrx->rxfilter - UPGT_EEPROM_RX_CONST; 1102 1.2.2.2 yamt 1103 1.2.2.2 yamt DPRINTF(2, "%s: hwrx option value=0x%04x\n", 1104 1.2.2.2 yamt device_xname(sc->sc_dev), sc->sc_eeprom_hwrx); 1105 1.2.2.2 yamt } 1106 1.2.2.2 yamt 1107 1.2.2.2 yamt static void 1108 1.2.2.2 yamt upgt_eeprom_parse_freq3(struct upgt_softc *sc, uint8_t *data, int len) 1109 1.2.2.2 yamt { 1110 1.2.2.2 yamt struct upgt_eeprom_freq3_header *freq3_header; 1111 1.2.2.2 yamt struct upgt_lmac_freq3 *freq3; 1112 1.2.2.2 yamt int i, elements, flags; 1113 1.2.2.2 yamt unsigned channel; 1114 1.2.2.2 yamt 1115 1.2.2.2 yamt freq3_header = (struct upgt_eeprom_freq3_header *)data; 1116 1.2.2.2 yamt freq3 = (struct upgt_lmac_freq3 *)(freq3_header + 1); 1117 1.2.2.2 yamt 1118 1.2.2.2 yamt flags = freq3_header->flags; 1119 1.2.2.2 yamt elements = freq3_header->elements; 1120 1.2.2.2 yamt 1121 1.2.2.2 yamt DPRINTF(2, "%s: flags=0x%02x\n", device_xname(sc->sc_dev), flags); 1122 1.2.2.2 yamt DPRINTF(2, "%s: elements=%d\n", device_xname(sc->sc_dev), elements); 1123 1.2.2.2 yamt 1124 1.2.2.2 yamt for (i = 0; i < elements; i++) { 1125 1.2.2.2 yamt channel = ieee80211_mhz2ieee(le16toh(freq3[i].freq), 0); 1126 1.2.2.2 yamt 1127 1.2.2.2 yamt sc->sc_eeprom_freq3[channel] = freq3[i]; 1128 1.2.2.2 yamt 1129 1.2.2.2 yamt DPRINTF(2, "%s: frequence=%d, channel=%d\n", 1130 1.2.2.2 yamt device_xname(sc->sc_dev), 1131 1.2.2.2 yamt le16toh(sc->sc_eeprom_freq3[channel].freq), channel); 1132 1.2.2.2 yamt } 1133 1.2.2.2 yamt } 1134 1.2.2.2 yamt 1135 1.2.2.2 yamt static void 1136 1.2.2.2 yamt upgt_eeprom_parse_freq4(struct upgt_softc *sc, uint8_t *data, int len) 1137 1.2.2.2 yamt { 1138 1.2.2.2 yamt struct upgt_eeprom_freq4_header *freq4_header; 1139 1.2.2.2 yamt struct upgt_eeprom_freq4_1 *freq4_1; 1140 1.2.2.2 yamt struct upgt_eeprom_freq4_2 *freq4_2; 1141 1.2.2.2 yamt int i, j, elements, settings, flags; 1142 1.2.2.2 yamt unsigned channel; 1143 1.2.2.2 yamt 1144 1.2.2.2 yamt freq4_header = (struct upgt_eeprom_freq4_header *)data; 1145 1.2.2.2 yamt freq4_1 = (struct upgt_eeprom_freq4_1 *)(freq4_header + 1); 1146 1.2.2.2 yamt 1147 1.2.2.2 yamt flags = freq4_header->flags; 1148 1.2.2.2 yamt elements = freq4_header->elements; 1149 1.2.2.2 yamt settings = freq4_header->settings; 1150 1.2.2.2 yamt 1151 1.2.2.2 yamt /* we need this value later */ 1152 1.2.2.2 yamt sc->sc_eeprom_freq6_settings = freq4_header->settings; 1153 1.2.2.2 yamt 1154 1.2.2.2 yamt DPRINTF(2, "%s: flags=0x%02x\n", device_xname(sc->sc_dev), flags); 1155 1.2.2.2 yamt DPRINTF(2, "%s: elements=%d\n", device_xname(sc->sc_dev), elements); 1156 1.2.2.2 yamt DPRINTF(2, "%s: settings=%d\n", device_xname(sc->sc_dev), settings); 1157 1.2.2.2 yamt 1158 1.2.2.2 yamt for (i = 0; i < elements; i++) { 1159 1.2.2.2 yamt channel = ieee80211_mhz2ieee(le16toh(freq4_1[i].freq), 0); 1160 1.2.2.2 yamt 1161 1.2.2.2 yamt freq4_2 = (struct upgt_eeprom_freq4_2 *)freq4_1[i].data; 1162 1.2.2.2 yamt 1163 1.2.2.2 yamt for (j = 0; j < settings; j++) { 1164 1.2.2.2 yamt sc->sc_eeprom_freq4[channel][j].cmd = freq4_2[j]; 1165 1.2.2.2 yamt sc->sc_eeprom_freq4[channel][j].pad = 0; 1166 1.2.2.2 yamt } 1167 1.2.2.2 yamt 1168 1.2.2.2 yamt DPRINTF(2, "%s: frequence=%d, channel=%d\n", 1169 1.2.2.2 yamt device_xname(sc->sc_dev), 1170 1.2.2.2 yamt le16toh(freq4_1[i].freq), channel); 1171 1.2.2.2 yamt } 1172 1.2.2.2 yamt } 1173 1.2.2.2 yamt 1174 1.2.2.2 yamt static void 1175 1.2.2.2 yamt upgt_eeprom_parse_freq6(struct upgt_softc *sc, uint8_t *data, int len) 1176 1.2.2.2 yamt { 1177 1.2.2.2 yamt struct upgt_lmac_freq6 *freq6; 1178 1.2.2.2 yamt int i, elements; 1179 1.2.2.2 yamt unsigned channel; 1180 1.2.2.2 yamt 1181 1.2.2.2 yamt freq6 = (struct upgt_lmac_freq6 *)data; 1182 1.2.2.2 yamt 1183 1.2.2.2 yamt elements = len / sizeof(struct upgt_lmac_freq6); 1184 1.2.2.2 yamt 1185 1.2.2.2 yamt DPRINTF(2, "%s: elements=%d\n", device_xname(sc->sc_dev), elements); 1186 1.2.2.2 yamt 1187 1.2.2.2 yamt for (i = 0; i < elements; i++) { 1188 1.2.2.2 yamt channel = ieee80211_mhz2ieee(le16toh(freq6[i].freq), 0); 1189 1.2.2.2 yamt 1190 1.2.2.2 yamt sc->sc_eeprom_freq6[channel] = freq6[i]; 1191 1.2.2.2 yamt 1192 1.2.2.2 yamt DPRINTF(2, "%s: frequence=%d, channel=%d\n", 1193 1.2.2.2 yamt device_xname(sc->sc_dev), 1194 1.2.2.2 yamt le16toh(sc->sc_eeprom_freq6[channel].freq), channel); 1195 1.2.2.2 yamt } 1196 1.2.2.2 yamt } 1197 1.2.2.2 yamt 1198 1.2.2.2 yamt static int 1199 1.2.2.2 yamt upgt_ioctl(struct ifnet *ifp, u_long cmd, void *data) 1200 1.2.2.2 yamt { 1201 1.2.2.2 yamt struct upgt_softc *sc = ifp->if_softc; 1202 1.2.2.2 yamt struct ieee80211com *ic = &sc->sc_ic; 1203 1.2.2.2 yamt int s, error = 0; 1204 1.2.2.2 yamt 1205 1.2.2.2 yamt s = splnet(); 1206 1.2.2.2 yamt 1207 1.2.2.2 yamt switch (cmd) { 1208 1.2.2.2 yamt case SIOCSIFFLAGS: 1209 1.2.2.2 yamt if ((error = ifioctl_common(ifp, cmd, data)) != 0) 1210 1.2.2.2 yamt break; 1211 1.2.2.2 yamt if (ifp->if_flags & IFF_UP) { 1212 1.2.2.2 yamt if ((ifp->if_flags & IFF_RUNNING) == 0) 1213 1.2.2.2 yamt upgt_init(ifp); 1214 1.2.2.2 yamt } else { 1215 1.2.2.2 yamt if (ifp->if_flags & IFF_RUNNING) 1216 1.2.2.2 yamt upgt_stop(sc); 1217 1.2.2.2 yamt } 1218 1.2.2.2 yamt break; 1219 1.2.2.2 yamt case SIOCADDMULTI: 1220 1.2.2.2 yamt case SIOCDELMULTI: 1221 1.2.2.2 yamt if ((error = ether_ioctl(ifp, cmd, data)) == ENETRESET) { 1222 1.2.2.2 yamt /* setup multicast filter, etc */ 1223 1.2.2.2 yamt error = 0; 1224 1.2.2.2 yamt } 1225 1.2.2.2 yamt break; 1226 1.2.2.2 yamt default: 1227 1.2.2.2 yamt error = ieee80211_ioctl(ic, cmd, data); 1228 1.2.2.2 yamt break; 1229 1.2.2.2 yamt } 1230 1.2.2.2 yamt 1231 1.2.2.2 yamt if (error == ENETRESET) { 1232 1.2.2.2 yamt if ((ifp->if_flags & (IFF_UP | IFF_RUNNING)) == 1233 1.2.2.2 yamt (IFF_UP | IFF_RUNNING)) 1234 1.2.2.2 yamt upgt_init(ifp); 1235 1.2.2.2 yamt error = 0; 1236 1.2.2.2 yamt } 1237 1.2.2.2 yamt 1238 1.2.2.2 yamt splx(s); 1239 1.2.2.2 yamt 1240 1.2.2.2 yamt return error; 1241 1.2.2.2 yamt } 1242 1.2.2.2 yamt 1243 1.2.2.2 yamt static int 1244 1.2.2.2 yamt upgt_init(struct ifnet *ifp) 1245 1.2.2.2 yamt { 1246 1.2.2.2 yamt struct upgt_softc *sc = ifp->if_softc; 1247 1.2.2.2 yamt struct ieee80211com *ic = &sc->sc_ic; 1248 1.2.2.2 yamt 1249 1.2.2.2 yamt DPRINTF(1, "%s: %s\n", device_xname(sc->sc_dev), __func__); 1250 1.2.2.2 yamt 1251 1.2.2.2 yamt if (ifp->if_flags & IFF_RUNNING) 1252 1.2.2.2 yamt upgt_stop(sc); 1253 1.2.2.2 yamt 1254 1.2.2.2 yamt ifp->if_flags |= IFF_RUNNING; 1255 1.2.2.2 yamt ifp->if_flags &= ~IFF_OACTIVE; 1256 1.2.2.2 yamt 1257 1.2.2.2 yamt IEEE80211_ADDR_COPY(ic->ic_myaddr, CLLADDR(ifp->if_sadl)); 1258 1.2.2.2 yamt 1259 1.2.2.2 yamt /* setup device rates */ 1260 1.2.2.2 yamt upgt_setup_rates(sc); 1261 1.2.2.2 yamt 1262 1.2.2.2 yamt if (ic->ic_opmode == IEEE80211_M_MONITOR) 1263 1.2.2.2 yamt ieee80211_new_state(ic, IEEE80211_S_RUN, -1); 1264 1.2.2.2 yamt else 1265 1.2.2.2 yamt ieee80211_new_state(ic, IEEE80211_S_SCAN, -1); 1266 1.2.2.2 yamt 1267 1.2.2.2 yamt return 0; 1268 1.2.2.2 yamt } 1269 1.2.2.2 yamt 1270 1.2.2.2 yamt static void 1271 1.2.2.2 yamt upgt_stop(struct upgt_softc *sc) 1272 1.2.2.2 yamt { 1273 1.2.2.2 yamt struct ieee80211com *ic = &sc->sc_ic; 1274 1.2.2.2 yamt struct ifnet *ifp = &sc->sc_if; 1275 1.2.2.2 yamt 1276 1.2.2.2 yamt DPRINTF(1, "%s: %s\n", device_xname(sc->sc_dev), __func__); 1277 1.2.2.2 yamt 1278 1.2.2.2 yamt /* device down */ 1279 1.2.2.2 yamt ifp->if_timer = 0; 1280 1.2.2.2 yamt ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE); 1281 1.2.2.2 yamt 1282 1.2.2.2 yamt /* change device back to initial state */ 1283 1.2.2.2 yamt ieee80211_new_state(ic, IEEE80211_S_INIT, -1); 1284 1.2.2.2 yamt } 1285 1.2.2.2 yamt 1286 1.2.2.2 yamt static int 1287 1.2.2.2 yamt upgt_media_change(struct ifnet *ifp) 1288 1.2.2.2 yamt { 1289 1.2.2.2 yamt struct upgt_softc *sc = ifp->if_softc; 1290 1.2.2.2 yamt int error; 1291 1.2.2.2 yamt 1292 1.2.2.2 yamt DPRINTF(1, "%s: %s\n", device_xname(sc->sc_dev), __func__); 1293 1.2.2.2 yamt 1294 1.2.2.2 yamt if ((error = ieee80211_media_change(ifp) != ENETRESET)) 1295 1.2.2.2 yamt return error; 1296 1.2.2.2 yamt 1297 1.2.2.2 yamt if ((ifp->if_flags & (IFF_UP | IFF_RUNNING)) == 1298 1.2.2.2 yamt (IFF_UP | IFF_RUNNING)) { 1299 1.2.2.2 yamt /* give pending USB transfers a chance to finish */ 1300 1.2.2.2 yamt usbd_delay_ms(sc->sc_udev, 100); 1301 1.2.2.2 yamt upgt_init(ifp); 1302 1.2.2.2 yamt } 1303 1.2.2.2 yamt 1304 1.2.2.2 yamt return 0; 1305 1.2.2.2 yamt } 1306 1.2.2.2 yamt 1307 1.2.2.2 yamt static void 1308 1.2.2.2 yamt upgt_newassoc(struct ieee80211_node *ni, int isnew) 1309 1.2.2.2 yamt { 1310 1.2.2.2 yamt 1311 1.2.2.2 yamt ni->ni_txrate = 0; 1312 1.2.2.2 yamt } 1313 1.2.2.2 yamt 1314 1.2.2.2 yamt static int 1315 1.2.2.2 yamt upgt_newstate(struct ieee80211com *ic, enum ieee80211_state nstate, int arg) 1316 1.2.2.2 yamt { 1317 1.2.2.2 yamt struct upgt_softc *sc = ic->ic_ifp->if_softc; 1318 1.2.2.2 yamt 1319 1.2.2.2 yamt usb_rem_task(sc->sc_udev, &sc->sc_task_newstate); 1320 1.2.2.2 yamt callout_stop(&sc->scan_to); 1321 1.2.2.2 yamt 1322 1.2.2.2 yamt /* do it in a process context */ 1323 1.2.2.2 yamt sc->sc_state = nstate; 1324 1.2.2.2 yamt sc->sc_arg = arg; 1325 1.2.2.2 yamt usb_add_task(sc->sc_udev, &sc->sc_task_newstate, USB_TASKQ_DRIVER); 1326 1.2.2.2 yamt 1327 1.2.2.2 yamt return 0; 1328 1.2.2.2 yamt } 1329 1.2.2.2 yamt 1330 1.2.2.2 yamt static void 1331 1.2.2.2 yamt upgt_newstate_task(void *arg) 1332 1.2.2.2 yamt { 1333 1.2.2.2 yamt struct upgt_softc *sc = arg; 1334 1.2.2.2 yamt struct ieee80211com *ic = &sc->sc_ic; 1335 1.2.2.2 yamt struct ieee80211_node *ni; 1336 1.2.2.2 yamt unsigned channel; 1337 1.2.2.2 yamt 1338 1.2.2.2 yamt mutex_enter(&sc->sc_mtx); 1339 1.2.2.2 yamt 1340 1.2.2.2 yamt switch (sc->sc_state) { 1341 1.2.2.2 yamt case IEEE80211_S_INIT: 1342 1.2.2.2 yamt DPRINTF(1, "%s: newstate is IEEE80211_S_INIT\n", 1343 1.2.2.2 yamt device_xname(sc->sc_dev)); 1344 1.2.2.2 yamt 1345 1.2.2.2 yamt /* do not accept any frames if the device is down */ 1346 1.2.2.2 yamt upgt_set_macfilter(sc, IEEE80211_S_INIT); 1347 1.2.2.2 yamt upgt_set_led(sc, UPGT_LED_OFF); 1348 1.2.2.2 yamt break; 1349 1.2.2.2 yamt case IEEE80211_S_SCAN: 1350 1.2.2.2 yamt DPRINTF(1, "%s: newstate is IEEE80211_S_SCAN\n", 1351 1.2.2.2 yamt device_xname(sc->sc_dev)); 1352 1.2.2.2 yamt 1353 1.2.2.2 yamt channel = ieee80211_chan2ieee(ic, ic->ic_curchan); 1354 1.2.2.2 yamt upgt_set_channel(sc, channel); 1355 1.2.2.2 yamt upgt_set_macfilter(sc, IEEE80211_S_SCAN); 1356 1.2.2.2 yamt callout_schedule(&sc->scan_to, hz / 5); 1357 1.2.2.2 yamt break; 1358 1.2.2.2 yamt case IEEE80211_S_AUTH: 1359 1.2.2.2 yamt DPRINTF(1, "%s: newstate is IEEE80211_S_AUTH\n", 1360 1.2.2.2 yamt device_xname(sc->sc_dev)); 1361 1.2.2.2 yamt 1362 1.2.2.2 yamt channel = ieee80211_chan2ieee(ic, ic->ic_curchan); 1363 1.2.2.2 yamt upgt_set_channel(sc, channel); 1364 1.2.2.2 yamt break; 1365 1.2.2.2 yamt case IEEE80211_S_ASSOC: 1366 1.2.2.2 yamt DPRINTF(1, "%s: newstate is IEEE80211_S_ASSOC\n", 1367 1.2.2.2 yamt device_xname(sc->sc_dev)); 1368 1.2.2.2 yamt 1369 1.2.2.2 yamt channel = ieee80211_chan2ieee(ic, ic->ic_curchan); 1370 1.2.2.2 yamt upgt_set_channel(sc, channel); 1371 1.2.2.2 yamt break; 1372 1.2.2.2 yamt case IEEE80211_S_RUN: 1373 1.2.2.2 yamt DPRINTF(1, "%s: newstate is IEEE80211_S_RUN\n", 1374 1.2.2.2 yamt device_xname(sc->sc_dev)); 1375 1.2.2.2 yamt 1376 1.2.2.2 yamt channel = ieee80211_chan2ieee(ic, ic->ic_curchan); 1377 1.2.2.2 yamt upgt_set_channel(sc, channel); 1378 1.2.2.2 yamt 1379 1.2.2.2 yamt ni = ic->ic_bss; 1380 1.2.2.2 yamt 1381 1.2.2.2 yamt /* 1382 1.2.2.2 yamt * TX rate control is done by the firmware. 1383 1.2.2.2 yamt * Report the maximum rate which is available therefore. 1384 1.2.2.2 yamt */ 1385 1.2.2.2 yamt ni->ni_txrate = ni->ni_rates.rs_nrates - 1; 1386 1.2.2.2 yamt 1387 1.2.2.2 yamt if (ic->ic_opmode != IEEE80211_M_MONITOR) 1388 1.2.2.2 yamt upgt_set_macfilter(sc, IEEE80211_S_RUN); 1389 1.2.2.2 yamt upgt_set_led(sc, UPGT_LED_ON); 1390 1.2.2.2 yamt break; 1391 1.2.2.2 yamt } 1392 1.2.2.2 yamt 1393 1.2.2.2 yamt mutex_exit(&sc->sc_mtx); 1394 1.2.2.2 yamt 1395 1.2.2.2 yamt sc->sc_newstate(ic, sc->sc_state, sc->sc_arg); 1396 1.2.2.2 yamt } 1397 1.2.2.2 yamt 1398 1.2.2.2 yamt static void 1399 1.2.2.2 yamt upgt_next_scan(void *arg) 1400 1.2.2.2 yamt { 1401 1.2.2.2 yamt struct upgt_softc *sc = arg; 1402 1.2.2.2 yamt struct ieee80211com *ic = &sc->sc_ic; 1403 1.2.2.2 yamt 1404 1.2.2.2 yamt DPRINTF(2, "%s: %s\n", device_xname(sc->sc_dev), __func__); 1405 1.2.2.2 yamt 1406 1.2.2.2 yamt if (ic->ic_state == IEEE80211_S_SCAN) 1407 1.2.2.2 yamt ieee80211_next_scan(ic); 1408 1.2.2.2 yamt } 1409 1.2.2.2 yamt 1410 1.2.2.2 yamt static void 1411 1.2.2.2 yamt upgt_start(struct ifnet *ifp) 1412 1.2.2.2 yamt { 1413 1.2.2.2 yamt struct upgt_softc *sc = ifp->if_softc; 1414 1.2.2.2 yamt struct ieee80211com *ic = &sc->sc_ic; 1415 1.2.2.2 yamt struct ether_header *eh; 1416 1.2.2.2 yamt struct ieee80211_node *ni; 1417 1.2.2.2 yamt struct mbuf *m; 1418 1.2.2.2 yamt int i; 1419 1.2.2.2 yamt 1420 1.2.2.2 yamt /* don't transmit packets if interface is busy or down */ 1421 1.2.2.2 yamt if ((ifp->if_flags & (IFF_RUNNING | IFF_OACTIVE)) != IFF_RUNNING) 1422 1.2.2.2 yamt return; 1423 1.2.2.2 yamt 1424 1.2.2.2 yamt DPRINTF(2, "%s: %s\n", device_xname(sc->sc_dev), __func__); 1425 1.2.2.2 yamt 1426 1.2.2.2 yamt for (i = 0; i < UPGT_TX_COUNT; i++) { 1427 1.2.2.2 yamt struct upgt_data *data_tx = &sc->tx_data[i]; 1428 1.2.2.2 yamt 1429 1.2.2.2 yamt if (data_tx->m != NULL) 1430 1.2.2.2 yamt continue; 1431 1.2.2.2 yamt 1432 1.2.2.2 yamt IF_POLL(&ic->ic_mgtq, m); 1433 1.2.2.2 yamt if (m != NULL) { 1434 1.2.2.2 yamt /* management frame */ 1435 1.2.2.2 yamt IF_DEQUEUE(&ic->ic_mgtq, m); 1436 1.2.2.2 yamt 1437 1.2.2.2 yamt ni = (struct ieee80211_node *)m->m_pkthdr.rcvif; 1438 1.2.2.2 yamt m->m_pkthdr.rcvif = NULL; 1439 1.2.2.2 yamt 1440 1.2.2.2 yamt bpf_mtap3(ic->ic_rawbpf, m); 1441 1.2.2.2 yamt 1442 1.2.2.2 yamt if ((data_tx->addr = upgt_mem_alloc(sc)) == 0) { 1443 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 1444 1.2.2.2 yamt "no free prism memory\n"); 1445 1.2.2.2 yamt m_freem(m); 1446 1.2.2.2 yamt ifp->if_oerrors++; 1447 1.2.2.2 yamt break; 1448 1.2.2.2 yamt } 1449 1.2.2.2 yamt data_tx->ni = ni; 1450 1.2.2.2 yamt data_tx->m = m; 1451 1.2.2.2 yamt sc->tx_queued++; 1452 1.2.2.2 yamt } else { 1453 1.2.2.2 yamt /* data frame */ 1454 1.2.2.2 yamt if (ic->ic_state != IEEE80211_S_RUN) 1455 1.2.2.2 yamt break; 1456 1.2.2.2 yamt 1457 1.2.2.2 yamt IFQ_POLL(&ifp->if_snd, m); 1458 1.2.2.2 yamt if (m == NULL) 1459 1.2.2.2 yamt break; 1460 1.2.2.2 yamt 1461 1.2.2.2 yamt IFQ_DEQUEUE(&ifp->if_snd, m); 1462 1.2.2.2 yamt if (m->m_len < sizeof(struct ether_header) && 1463 1.2.2.2 yamt !(m = m_pullup(m, sizeof(struct ether_header)))) 1464 1.2.2.2 yamt continue; 1465 1.2.2.2 yamt 1466 1.2.2.2 yamt eh = mtod(m, struct ether_header *); 1467 1.2.2.2 yamt ni = ieee80211_find_txnode(ic, eh->ether_dhost); 1468 1.2.2.2 yamt if (ni == NULL) { 1469 1.2.2.2 yamt m_freem(m); 1470 1.2.2.2 yamt continue; 1471 1.2.2.2 yamt } 1472 1.2.2.2 yamt 1473 1.2.2.2 yamt bpf_mtap(ifp, m); 1474 1.2.2.2 yamt 1475 1.2.2.2 yamt m = ieee80211_encap(ic, m, ni); 1476 1.2.2.2 yamt if (m == NULL) { 1477 1.2.2.2 yamt ieee80211_free_node(ni); 1478 1.2.2.2 yamt continue; 1479 1.2.2.2 yamt } 1480 1.2.2.2 yamt 1481 1.2.2.2 yamt bpf_mtap3(ic->ic_rawbpf, m); 1482 1.2.2.2 yamt 1483 1.2.2.2 yamt if ((data_tx->addr = upgt_mem_alloc(sc)) == 0) { 1484 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 1485 1.2.2.2 yamt "no free prism memory\n"); 1486 1.2.2.2 yamt m_freem(m); 1487 1.2.2.2 yamt ieee80211_free_node(ni); 1488 1.2.2.2 yamt ifp->if_oerrors++; 1489 1.2.2.2 yamt break; 1490 1.2.2.2 yamt } 1491 1.2.2.2 yamt data_tx->ni = ni; 1492 1.2.2.2 yamt data_tx->m = m; 1493 1.2.2.2 yamt sc->tx_queued++; 1494 1.2.2.2 yamt } 1495 1.2.2.2 yamt } 1496 1.2.2.2 yamt 1497 1.2.2.2 yamt if (sc->tx_queued > 0) { 1498 1.2.2.2 yamt DPRINTF(2, "%s: tx_queued=%d\n", 1499 1.2.2.2 yamt device_xname(sc->sc_dev), sc->tx_queued); 1500 1.2.2.2 yamt /* process the TX queue in process context */ 1501 1.2.2.2 yamt ifp->if_timer = 5; 1502 1.2.2.2 yamt ifp->if_flags |= IFF_OACTIVE; 1503 1.2.2.2 yamt usb_rem_task(sc->sc_udev, &sc->sc_task_tx); 1504 1.2.2.2 yamt usb_add_task(sc->sc_udev, &sc->sc_task_tx, USB_TASKQ_DRIVER); 1505 1.2.2.2 yamt } 1506 1.2.2.2 yamt } 1507 1.2.2.2 yamt 1508 1.2.2.2 yamt static void 1509 1.2.2.2 yamt upgt_watchdog(struct ifnet *ifp) 1510 1.2.2.2 yamt { 1511 1.2.2.2 yamt struct upgt_softc *sc = ifp->if_softc; 1512 1.2.2.2 yamt struct ieee80211com *ic = &sc->sc_ic; 1513 1.2.2.2 yamt 1514 1.2.2.2 yamt if (ic->ic_state == IEEE80211_S_INIT) 1515 1.2.2.2 yamt return; 1516 1.2.2.2 yamt 1517 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, "watchdog timeout\n"); 1518 1.2.2.2 yamt 1519 1.2.2.2 yamt /* TODO: what shall we do on TX timeout? */ 1520 1.2.2.2 yamt 1521 1.2.2.2 yamt ieee80211_watchdog(ic); 1522 1.2.2.2 yamt } 1523 1.2.2.2 yamt 1524 1.2.2.2 yamt static void 1525 1.2.2.2 yamt upgt_tx_task(void *arg) 1526 1.2.2.2 yamt { 1527 1.2.2.2 yamt struct upgt_softc *sc = arg; 1528 1.2.2.2 yamt struct ieee80211com *ic = &sc->sc_ic; 1529 1.2.2.2 yamt struct ieee80211_frame *wh; 1530 1.2.2.2 yamt struct ieee80211_key *k; 1531 1.2.2.2 yamt struct ifnet *ifp = &sc->sc_if; 1532 1.2.2.2 yamt struct upgt_lmac_mem *mem; 1533 1.2.2.2 yamt struct upgt_lmac_tx_desc *txdesc; 1534 1.2.2.2 yamt struct mbuf *m; 1535 1.2.2.2 yamt uint32_t addr; 1536 1.2.2.2 yamt int i, len, pad, s; 1537 1.2.2.2 yamt usbd_status error; 1538 1.2.2.2 yamt 1539 1.2.2.2 yamt mutex_enter(&sc->sc_mtx); 1540 1.2.2.2 yamt upgt_set_led(sc, UPGT_LED_BLINK); 1541 1.2.2.2 yamt mutex_exit(&sc->sc_mtx); 1542 1.2.2.2 yamt 1543 1.2.2.2 yamt s = splnet(); 1544 1.2.2.2 yamt 1545 1.2.2.2 yamt for (i = 0; i < UPGT_TX_COUNT; i++) { 1546 1.2.2.2 yamt struct upgt_data *data_tx = &sc->tx_data[i]; 1547 1.2.2.2 yamt 1548 1.2.2.2 yamt if (data_tx->m == NULL) 1549 1.2.2.2 yamt continue; 1550 1.2.2.2 yamt 1551 1.2.2.2 yamt m = data_tx->m; 1552 1.2.2.2 yamt addr = data_tx->addr + UPGT_MEMSIZE_FRAME_HEAD; 1553 1.2.2.2 yamt 1554 1.2.2.2 yamt /* 1555 1.2.2.2 yamt * Software crypto. 1556 1.2.2.2 yamt */ 1557 1.2.2.2 yamt wh = mtod(m, struct ieee80211_frame *); 1558 1.2.2.2 yamt 1559 1.2.2.2 yamt if (wh->i_fc[1] & IEEE80211_FC1_WEP) { 1560 1.2.2.2 yamt k = ieee80211_crypto_encap(ic, data_tx->ni, m); 1561 1.2.2.2 yamt if (k == NULL) { 1562 1.2.2.2 yamt m_freem(m); 1563 1.2.2.2 yamt data_tx->m = NULL; 1564 1.2.2.2 yamt ieee80211_free_node(data_tx->ni); 1565 1.2.2.2 yamt data_tx->ni = NULL; 1566 1.2.2.2 yamt ifp->if_oerrors++; 1567 1.2.2.2 yamt break; 1568 1.2.2.2 yamt } 1569 1.2.2.2 yamt 1570 1.2.2.2 yamt /* in case packet header moved, reset pointer */ 1571 1.2.2.2 yamt wh = mtod(m, struct ieee80211_frame *); 1572 1.2.2.2 yamt } 1573 1.2.2.2 yamt 1574 1.2.2.2 yamt /* 1575 1.2.2.2 yamt * Transmit the URB containing the TX data. 1576 1.2.2.2 yamt */ 1577 1.2.2.2 yamt memset(data_tx->buf, 0, sizeof(*mem) + sizeof(*txdesc)); 1578 1.2.2.2 yamt 1579 1.2.2.2 yamt mem = (struct upgt_lmac_mem *)data_tx->buf; 1580 1.2.2.2 yamt mem->addr = htole32(addr); 1581 1.2.2.2 yamt 1582 1.2.2.2 yamt txdesc = (struct upgt_lmac_tx_desc *)(mem + 1); 1583 1.2.2.2 yamt 1584 1.2.2.2 yamt /* XXX differ between data and mgmt frames? */ 1585 1.2.2.2 yamt txdesc->header1.flags = UPGT_H1_FLAGS_TX_DATA; 1586 1.2.2.2 yamt txdesc->header1.type = UPGT_H1_TYPE_TX_DATA; 1587 1.2.2.2 yamt txdesc->header1.len = htole16(m->m_pkthdr.len); 1588 1.2.2.2 yamt 1589 1.2.2.2 yamt txdesc->header2.reqid = htole32(data_tx->addr); 1590 1.2.2.2 yamt txdesc->header2.type = htole16(UPGT_H2_TYPE_TX_ACK_YES); 1591 1.2.2.2 yamt txdesc->header2.flags = htole16(UPGT_H2_FLAGS_TX_ACK_YES); 1592 1.2.2.2 yamt 1593 1.2.2.2 yamt if ((wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK) == 1594 1.2.2.2 yamt IEEE80211_FC0_TYPE_MGT) { 1595 1.2.2.2 yamt /* always send mgmt frames at lowest rate (DS1) */ 1596 1.2.2.2 yamt memset(txdesc->rates, 0x10, sizeof(txdesc->rates)); 1597 1.2.2.2 yamt } else { 1598 1.2.2.2 yamt memcpy(txdesc->rates, sc->sc_cur_rateset, 1599 1.2.2.2 yamt sizeof(txdesc->rates)); 1600 1.2.2.2 yamt } 1601 1.2.2.2 yamt txdesc->type = htole32(UPGT_TX_DESC_TYPE_DATA); 1602 1.2.2.2 yamt txdesc->pad3[0] = UPGT_TX_DESC_PAD3_SIZE; 1603 1.2.2.2 yamt 1604 1.2.2.2 yamt if (sc->sc_drvbpf != NULL) { 1605 1.2.2.2 yamt struct upgt_tx_radiotap_header *tap = &sc->sc_txtap; 1606 1.2.2.2 yamt 1607 1.2.2.2 yamt tap->wt_flags = 0; 1608 1.2.2.2 yamt tap->wt_rate = 0; /* TODO: where to get from? */ 1609 1.2.2.2 yamt tap->wt_chan_freq = htole16(ic->ic_curchan->ic_freq); 1610 1.2.2.2 yamt tap->wt_chan_flags = htole16(ic->ic_curchan->ic_flags); 1611 1.2.2.2 yamt 1612 1.2.2.2 yamt bpf_mtap2(sc->sc_drvbpf, tap, sc->sc_txtap_len, m); 1613 1.2.2.2 yamt } 1614 1.2.2.2 yamt 1615 1.2.2.2 yamt /* copy frame below our TX descriptor header */ 1616 1.2.2.2 yamt m_copydata(m, 0, m->m_pkthdr.len, 1617 1.2.2.2 yamt data_tx->buf + sizeof(*mem) + sizeof(*txdesc)); 1618 1.2.2.2 yamt 1619 1.2.2.2 yamt /* calculate frame size */ 1620 1.2.2.2 yamt len = sizeof(*mem) + sizeof(*txdesc) + m->m_pkthdr.len; 1621 1.2.2.2 yamt 1622 1.2.2.2 yamt if (len & 3) { 1623 1.2.2.2 yamt /* we need to align the frame to a 4 byte boundary */ 1624 1.2.2.2 yamt pad = 4 - (len & 3); 1625 1.2.2.2 yamt memset(data_tx->buf + len, 0, pad); 1626 1.2.2.2 yamt len += pad; 1627 1.2.2.2 yamt } 1628 1.2.2.2 yamt 1629 1.2.2.2 yamt /* calculate frame checksum */ 1630 1.2.2.2 yamt mem->chksum = upgt_chksum_le((uint32_t *)txdesc, 1631 1.2.2.2 yamt len - sizeof(*mem)); 1632 1.2.2.2 yamt 1633 1.2.2.2 yamt /* we do not need the mbuf anymore */ 1634 1.2.2.2 yamt m_freem(m); 1635 1.2.2.2 yamt data_tx->m = NULL; 1636 1.2.2.2 yamt 1637 1.2.2.2 yamt ieee80211_free_node(data_tx->ni); 1638 1.2.2.2 yamt data_tx->ni = NULL; 1639 1.2.2.2 yamt 1640 1.2.2.2 yamt DPRINTF(2, "%s: TX start data sending\n", 1641 1.2.2.2 yamt device_xname(sc->sc_dev)); 1642 1.2.2.2 yamt 1643 1.2.2.2 yamt usbd_setup_xfer(data_tx->xfer, sc->sc_tx_pipeh, data_tx, 1644 1.2.2.2 yamt data_tx->buf, len, USBD_FORCE_SHORT_XFER | USBD_NO_COPY, 1645 1.2.2.2 yamt UPGT_USB_TIMEOUT, NULL); 1646 1.2.2.2 yamt error = usbd_transfer(data_tx->xfer); 1647 1.2.2.2 yamt if (error != USBD_NORMAL_COMPLETION && 1648 1.2.2.2 yamt error != USBD_IN_PROGRESS) { 1649 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 1650 1.2.2.2 yamt "could not transmit TX data URB\n"); 1651 1.2.2.2 yamt ifp->if_oerrors++; 1652 1.2.2.2 yamt break; 1653 1.2.2.2 yamt } 1654 1.2.2.2 yamt 1655 1.2.2.2 yamt DPRINTF(2, "%s: TX sent (%d bytes)\n", 1656 1.2.2.2 yamt device_xname(sc->sc_dev), len); 1657 1.2.2.2 yamt } 1658 1.2.2.2 yamt 1659 1.2.2.2 yamt splx(s); 1660 1.2.2.2 yamt 1661 1.2.2.2 yamt /* 1662 1.2.2.2 yamt * If we don't regulary read the device statistics, the RX queue 1663 1.2.2.2 yamt * will stall. It's strange, but it works, so we keep reading 1664 1.2.2.2 yamt * the statistics here. *shrug* 1665 1.2.2.2 yamt */ 1666 1.2.2.2 yamt mutex_enter(&sc->sc_mtx); 1667 1.2.2.2 yamt upgt_get_stats(sc); 1668 1.2.2.2 yamt mutex_exit(&sc->sc_mtx); 1669 1.2.2.2 yamt } 1670 1.2.2.2 yamt 1671 1.2.2.2 yamt static void 1672 1.2.2.2 yamt upgt_tx_done(struct upgt_softc *sc, uint8_t *data) 1673 1.2.2.2 yamt { 1674 1.2.2.2 yamt struct ifnet *ifp = &sc->sc_if; 1675 1.2.2.2 yamt struct upgt_lmac_tx_done_desc *desc; 1676 1.2.2.2 yamt int i, s; 1677 1.2.2.2 yamt 1678 1.2.2.2 yamt s = splnet(); 1679 1.2.2.2 yamt 1680 1.2.2.2 yamt desc = (struct upgt_lmac_tx_done_desc *)data; 1681 1.2.2.2 yamt 1682 1.2.2.2 yamt for (i = 0; i < UPGT_TX_COUNT; i++) { 1683 1.2.2.2 yamt struct upgt_data *data_tx = &sc->tx_data[i]; 1684 1.2.2.2 yamt 1685 1.2.2.2 yamt if (data_tx->addr == le32toh(desc->header2.reqid)) { 1686 1.2.2.2 yamt upgt_mem_free(sc, data_tx->addr); 1687 1.2.2.2 yamt data_tx->addr = 0; 1688 1.2.2.2 yamt 1689 1.2.2.2 yamt sc->tx_queued--; 1690 1.2.2.2 yamt ifp->if_opackets++; 1691 1.2.2.2 yamt 1692 1.2.2.2 yamt DPRINTF(2, "%s: TX done: ", device_xname(sc->sc_dev)); 1693 1.2.2.2 yamt DPRINTF(2, "memaddr=0x%08x, status=0x%04x, rssi=%d, ", 1694 1.2.2.2 yamt le32toh(desc->header2.reqid), 1695 1.2.2.2 yamt le16toh(desc->status), 1696 1.2.2.2 yamt le16toh(desc->rssi)); 1697 1.2.2.2 yamt DPRINTF(2, "seq=%d\n", le16toh(desc->seq)); 1698 1.2.2.2 yamt break; 1699 1.2.2.2 yamt } 1700 1.2.2.2 yamt } 1701 1.2.2.2 yamt 1702 1.2.2.2 yamt if (sc->tx_queued == 0) { 1703 1.2.2.2 yamt /* TX queued was processed, continue */ 1704 1.2.2.2 yamt ifp->if_timer = 0; 1705 1.2.2.2 yamt ifp->if_flags &= ~IFF_OACTIVE; 1706 1.2.2.2 yamt upgt_start(ifp); 1707 1.2.2.2 yamt } 1708 1.2.2.2 yamt 1709 1.2.2.2 yamt splx(s); 1710 1.2.2.2 yamt } 1711 1.2.2.2 yamt 1712 1.2.2.2 yamt static void 1713 1.2.2.2 yamt upgt_rx_cb(usbd_xfer_handle xfer, usbd_private_handle priv, usbd_status status) 1714 1.2.2.2 yamt { 1715 1.2.2.2 yamt struct upgt_data *data_rx = priv; 1716 1.2.2.2 yamt struct upgt_softc *sc = data_rx->sc; 1717 1.2.2.2 yamt int len; 1718 1.2.2.2 yamt struct upgt_lmac_header *header; 1719 1.2.2.2 yamt struct upgt_lmac_eeprom *eeprom; 1720 1.2.2.2 yamt uint8_t h1_type; 1721 1.2.2.2 yamt uint16_t h2_type; 1722 1.2.2.2 yamt 1723 1.2.2.2 yamt DPRINTF(3, "%s: %s\n", device_xname(sc->sc_dev), __func__); 1724 1.2.2.2 yamt 1725 1.2.2.2 yamt if (status != USBD_NORMAL_COMPLETION) { 1726 1.2.2.2 yamt if (status == USBD_NOT_STARTED || status == USBD_CANCELLED) 1727 1.2.2.2 yamt return; 1728 1.2.2.2 yamt if (status == USBD_STALLED) 1729 1.2.2.2 yamt usbd_clear_endpoint_stall_async(sc->sc_rx_pipeh); 1730 1.2.2.2 yamt goto skip; 1731 1.2.2.2 yamt } 1732 1.2.2.2 yamt usbd_get_xfer_status(xfer, NULL, NULL, &len, NULL); 1733 1.2.2.2 yamt 1734 1.2.2.2 yamt /* 1735 1.2.2.2 yamt * Check what type of frame came in. 1736 1.2.2.2 yamt */ 1737 1.2.2.2 yamt header = (struct upgt_lmac_header *)(data_rx->buf + 4); 1738 1.2.2.2 yamt 1739 1.2.2.2 yamt h1_type = header->header1.type; 1740 1.2.2.2 yamt h2_type = le16toh(header->header2.type); 1741 1.2.2.2 yamt 1742 1.2.2.2 yamt if (h1_type == UPGT_H1_TYPE_CTRL && 1743 1.2.2.2 yamt h2_type == UPGT_H2_TYPE_EEPROM) { 1744 1.2.2.2 yamt eeprom = (struct upgt_lmac_eeprom *)(data_rx->buf + 4); 1745 1.2.2.2 yamt uint16_t eeprom_offset = le16toh(eeprom->offset); 1746 1.2.2.2 yamt uint16_t eeprom_len = le16toh(eeprom->len); 1747 1.2.2.2 yamt 1748 1.2.2.2 yamt DPRINTF(2, "%s: received EEPROM block (offset=%d, len=%d)\n", 1749 1.2.2.2 yamt device_xname(sc->sc_dev), eeprom_offset, eeprom_len); 1750 1.2.2.2 yamt 1751 1.2.2.2 yamt memcpy(sc->sc_eeprom + eeprom_offset, 1752 1.2.2.2 yamt data_rx->buf + sizeof(struct upgt_lmac_eeprom) + 4, 1753 1.2.2.2 yamt eeprom_len); 1754 1.2.2.2 yamt 1755 1.2.2.2 yamt /* EEPROM data has arrived in time, wakeup tsleep() */ 1756 1.2.2.2 yamt wakeup(sc); 1757 1.2.2.2 yamt } else 1758 1.2.2.2 yamt if (h1_type == UPGT_H1_TYPE_CTRL && 1759 1.2.2.2 yamt h2_type == UPGT_H2_TYPE_TX_DONE) { 1760 1.2.2.2 yamt DPRINTF(2, "%s: received 802.11 TX done\n", 1761 1.2.2.2 yamt device_xname(sc->sc_dev)); 1762 1.2.2.2 yamt 1763 1.2.2.2 yamt upgt_tx_done(sc, data_rx->buf + 4); 1764 1.2.2.2 yamt } else 1765 1.2.2.2 yamt if (h1_type == UPGT_H1_TYPE_RX_DATA || 1766 1.2.2.2 yamt h1_type == UPGT_H1_TYPE_RX_DATA_MGMT) { 1767 1.2.2.2 yamt DPRINTF(3, "%s: received 802.11 RX data\n", 1768 1.2.2.2 yamt device_xname(sc->sc_dev)); 1769 1.2.2.2 yamt 1770 1.2.2.2 yamt upgt_rx(sc, data_rx->buf + 4, le16toh(header->header1.len)); 1771 1.2.2.2 yamt } else 1772 1.2.2.2 yamt if (h1_type == UPGT_H1_TYPE_CTRL && 1773 1.2.2.2 yamt h2_type == UPGT_H2_TYPE_STATS) { 1774 1.2.2.2 yamt DPRINTF(2, "%s: received statistic data\n", 1775 1.2.2.2 yamt device_xname(sc->sc_dev)); 1776 1.2.2.2 yamt 1777 1.2.2.2 yamt /* TODO: what could we do with the statistic data? */ 1778 1.2.2.2 yamt } else { 1779 1.2.2.2 yamt /* ignore unknown frame types */ 1780 1.2.2.2 yamt DPRINTF(1, "%s: received unknown frame type 0x%02x\n", 1781 1.2.2.2 yamt device_xname(sc->sc_dev), header->header1.type); 1782 1.2.2.2 yamt } 1783 1.2.2.2 yamt 1784 1.2.2.2 yamt skip: /* setup new transfer */ 1785 1.2.2.2 yamt usbd_setup_xfer(xfer, sc->sc_rx_pipeh, data_rx, data_rx->buf, MCLBYTES, 1786 1.2.2.2 yamt USBD_SHORT_XFER_OK, USBD_NO_TIMEOUT, upgt_rx_cb); 1787 1.2.2.2 yamt (void)usbd_transfer(xfer); 1788 1.2.2.2 yamt } 1789 1.2.2.2 yamt 1790 1.2.2.2 yamt static void 1791 1.2.2.2 yamt upgt_rx(struct upgt_softc *sc, uint8_t *data, int pkglen) 1792 1.2.2.2 yamt { 1793 1.2.2.2 yamt struct ieee80211com *ic = &sc->sc_ic; 1794 1.2.2.2 yamt struct ifnet *ifp = &sc->sc_if; 1795 1.2.2.2 yamt struct upgt_lmac_rx_desc *rxdesc; 1796 1.2.2.2 yamt struct ieee80211_frame *wh; 1797 1.2.2.2 yamt struct ieee80211_node *ni; 1798 1.2.2.2 yamt struct mbuf *m; 1799 1.2.2.2 yamt int s; 1800 1.2.2.2 yamt 1801 1.2.2.2 yamt /* access RX packet descriptor */ 1802 1.2.2.2 yamt rxdesc = (struct upgt_lmac_rx_desc *)data; 1803 1.2.2.2 yamt 1804 1.2.2.2 yamt /* create mbuf which is suitable for strict alignment archs */ 1805 1.2.2.2 yamt #define ETHER_ALIGN 0 1806 1.2.2.2 yamt m = m_devget(rxdesc->data, pkglen, ETHER_ALIGN, ifp, NULL); 1807 1.2.2.2 yamt if (m == NULL) { 1808 1.2.2.2 yamt DPRINTF(1, "%s: could not create RX mbuf\n", 1809 1.2.2.2 yamt device_xname(sc->sc_dev)); 1810 1.2.2.2 yamt ifp->if_ierrors++; 1811 1.2.2.2 yamt return; 1812 1.2.2.2 yamt } 1813 1.2.2.2 yamt 1814 1.2.2.2 yamt s = splnet(); 1815 1.2.2.2 yamt 1816 1.2.2.2 yamt if (sc->sc_drvbpf != NULL) { 1817 1.2.2.2 yamt struct upgt_rx_radiotap_header *tap = &sc->sc_rxtap; 1818 1.2.2.2 yamt 1819 1.2.2.2 yamt tap->wr_flags = IEEE80211_RADIOTAP_F_FCS; 1820 1.2.2.2 yamt tap->wr_rate = upgt_rx_rate(sc, rxdesc->rate); 1821 1.2.2.2 yamt tap->wr_chan_freq = htole16(ic->ic_curchan->ic_freq); 1822 1.2.2.2 yamt tap->wr_chan_flags = htole16(ic->ic_curchan->ic_flags); 1823 1.2.2.2 yamt tap->wr_antsignal = rxdesc->rssi; 1824 1.2.2.2 yamt 1825 1.2.2.2 yamt bpf_mtap2(sc->sc_drvbpf, tap, sc->sc_rxtap_len, m); 1826 1.2.2.2 yamt } 1827 1.2.2.2 yamt 1828 1.2.2.2 yamt /* trim FCS */ 1829 1.2.2.2 yamt m_adj(m, -IEEE80211_CRC_LEN); 1830 1.2.2.2 yamt 1831 1.2.2.2 yamt wh = mtod(m, struct ieee80211_frame *); 1832 1.2.2.2 yamt ni = ieee80211_find_rxnode(ic, (struct ieee80211_frame_min *)wh); 1833 1.2.2.2 yamt 1834 1.2.2.2 yamt /* push the frame up to the 802.11 stack */ 1835 1.2.2.2 yamt ieee80211_input(ic, m, ni, rxdesc->rssi, 0); 1836 1.2.2.2 yamt 1837 1.2.2.2 yamt /* node is no longer needed */ 1838 1.2.2.2 yamt ieee80211_free_node(ni); 1839 1.2.2.2 yamt 1840 1.2.2.2 yamt splx(s); 1841 1.2.2.2 yamt 1842 1.2.2.2 yamt DPRINTF(3, "%s: RX done\n", device_xname(sc->sc_dev)); 1843 1.2.2.2 yamt } 1844 1.2.2.2 yamt 1845 1.2.2.2 yamt static void 1846 1.2.2.2 yamt upgt_setup_rates(struct upgt_softc *sc) 1847 1.2.2.2 yamt { 1848 1.2.2.2 yamt struct ieee80211com *ic = &sc->sc_ic; 1849 1.2.2.2 yamt 1850 1.2.2.2 yamt /* 1851 1.2.2.2 yamt * 0x01 = OFMD6 0x10 = DS1 1852 1.2.2.2 yamt * 0x04 = OFDM9 0x11 = DS2 1853 1.2.2.2 yamt * 0x06 = OFDM12 0x12 = DS5 1854 1.2.2.2 yamt * 0x07 = OFDM18 0x13 = DS11 1855 1.2.2.2 yamt * 0x08 = OFDM24 1856 1.2.2.2 yamt * 0x09 = OFDM36 1857 1.2.2.2 yamt * 0x0a = OFDM48 1858 1.2.2.2 yamt * 0x0b = OFDM54 1859 1.2.2.2 yamt */ 1860 1.2.2.2 yamt const uint8_t rateset_auto_11b[] = 1861 1.2.2.2 yamt { 0x13, 0x13, 0x12, 0x11, 0x11, 0x10, 0x10, 0x10 }; 1862 1.2.2.2 yamt const uint8_t rateset_auto_11g[] = 1863 1.2.2.2 yamt { 0x0b, 0x0a, 0x09, 0x08, 0x07, 0x06, 0x04, 0x01 }; 1864 1.2.2.2 yamt const uint8_t rateset_fix_11bg[] = 1865 1.2.2.2 yamt { 0x10, 0x11, 0x12, 0x13, 0x01, 0x04, 0x06, 0x07, 1866 1.2.2.2 yamt 0x08, 0x09, 0x0a, 0x0b }; 1867 1.2.2.2 yamt 1868 1.2.2.2 yamt if (ic->ic_fixed_rate == IEEE80211_FIXED_RATE_NONE) { 1869 1.2.2.2 yamt /* 1870 1.2.2.2 yamt * Automatic rate control is done by the device. 1871 1.2.2.2 yamt * We just pass the rateset from which the device 1872 1.2.2.2 yamt * will pickup a rate. 1873 1.2.2.2 yamt */ 1874 1.2.2.2 yamt if (ic->ic_curmode == IEEE80211_MODE_11B) 1875 1.2.2.2 yamt memcpy(sc->sc_cur_rateset, rateset_auto_11b, 1876 1.2.2.2 yamt sizeof(sc->sc_cur_rateset)); 1877 1.2.2.2 yamt if (ic->ic_curmode == IEEE80211_MODE_11G || 1878 1.2.2.2 yamt ic->ic_curmode == IEEE80211_MODE_AUTO) 1879 1.2.2.2 yamt memcpy(sc->sc_cur_rateset, rateset_auto_11g, 1880 1.2.2.2 yamt sizeof(sc->sc_cur_rateset)); 1881 1.2.2.2 yamt } else { 1882 1.2.2.2 yamt /* set a fixed rate */ 1883 1.2.2.2 yamt memset(sc->sc_cur_rateset, rateset_fix_11bg[ic->ic_fixed_rate], 1884 1.2.2.2 yamt sizeof(sc->sc_cur_rateset)); 1885 1.2.2.2 yamt } 1886 1.2.2.2 yamt } 1887 1.2.2.2 yamt 1888 1.2.2.2 yamt static uint8_t 1889 1.2.2.2 yamt upgt_rx_rate(struct upgt_softc *sc, const int rate) 1890 1.2.2.2 yamt { 1891 1.2.2.2 yamt struct ieee80211com *ic = &sc->sc_ic; 1892 1.2.2.2 yamt 1893 1.2.2.2 yamt if (ic->ic_curmode == IEEE80211_MODE_11B) { 1894 1.2.2.2 yamt if (rate < 0 || rate > 3) 1895 1.2.2.2 yamt /* invalid rate */ 1896 1.2.2.2 yamt return 0; 1897 1.2.2.2 yamt 1898 1.2.2.2 yamt switch (rate) { 1899 1.2.2.2 yamt case 0: 1900 1.2.2.2 yamt return 2; 1901 1.2.2.2 yamt case 1: 1902 1.2.2.2 yamt return 4; 1903 1.2.2.2 yamt case 2: 1904 1.2.2.2 yamt return 11; 1905 1.2.2.2 yamt case 3: 1906 1.2.2.2 yamt return 22; 1907 1.2.2.2 yamt default: 1908 1.2.2.2 yamt return 0; 1909 1.2.2.2 yamt } 1910 1.2.2.2 yamt } 1911 1.2.2.2 yamt 1912 1.2.2.2 yamt if (ic->ic_curmode == IEEE80211_MODE_11G) { 1913 1.2.2.2 yamt if (rate < 0 || rate > 11) 1914 1.2.2.2 yamt /* invalid rate */ 1915 1.2.2.2 yamt return 0; 1916 1.2.2.2 yamt 1917 1.2.2.2 yamt switch (rate) { 1918 1.2.2.2 yamt case 0: 1919 1.2.2.2 yamt return 2; 1920 1.2.2.2 yamt case 1: 1921 1.2.2.2 yamt return 4; 1922 1.2.2.2 yamt case 2: 1923 1.2.2.2 yamt return 11; 1924 1.2.2.2 yamt case 3: 1925 1.2.2.2 yamt return 22; 1926 1.2.2.2 yamt case 4: 1927 1.2.2.2 yamt return 12; 1928 1.2.2.2 yamt case 5: 1929 1.2.2.2 yamt return 18; 1930 1.2.2.2 yamt case 6: 1931 1.2.2.2 yamt return 24; 1932 1.2.2.2 yamt case 7: 1933 1.2.2.2 yamt return 36; 1934 1.2.2.2 yamt case 8: 1935 1.2.2.2 yamt return 48; 1936 1.2.2.2 yamt case 9: 1937 1.2.2.2 yamt return 72; 1938 1.2.2.2 yamt case 10: 1939 1.2.2.2 yamt return 96; 1940 1.2.2.2 yamt case 11: 1941 1.2.2.2 yamt return 108; 1942 1.2.2.2 yamt default: 1943 1.2.2.2 yamt return 0; 1944 1.2.2.2 yamt } 1945 1.2.2.2 yamt } 1946 1.2.2.2 yamt 1947 1.2.2.2 yamt return 0; 1948 1.2.2.2 yamt } 1949 1.2.2.2 yamt 1950 1.2.2.2 yamt static int 1951 1.2.2.2 yamt upgt_set_macfilter(struct upgt_softc *sc, uint8_t state) 1952 1.2.2.2 yamt { 1953 1.2.2.2 yamt struct ieee80211com *ic = &sc->sc_ic; 1954 1.2.2.2 yamt struct ieee80211_node *ni = ic->ic_bss; 1955 1.2.2.2 yamt struct upgt_data *data_cmd = &sc->cmd_data; 1956 1.2.2.2 yamt struct upgt_lmac_mem *mem; 1957 1.2.2.2 yamt struct upgt_lmac_filter *filter; 1958 1.2.2.2 yamt int len; 1959 1.2.2.2 yamt const uint8_t broadcast[] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; 1960 1.2.2.2 yamt 1961 1.2.2.2 yamt /* 1962 1.2.2.2 yamt * Transmit the URB containing the CMD data. 1963 1.2.2.2 yamt */ 1964 1.2.2.2 yamt len = sizeof(*mem) + sizeof(*filter); 1965 1.2.2.2 yamt 1966 1.2.2.2 yamt memset(data_cmd->buf, 0, len); 1967 1.2.2.2 yamt 1968 1.2.2.2 yamt mem = (struct upgt_lmac_mem *)data_cmd->buf; 1969 1.2.2.2 yamt mem->addr = htole32(sc->sc_memaddr_frame_start + 1970 1.2.2.2 yamt UPGT_MEMSIZE_FRAME_HEAD); 1971 1.2.2.2 yamt 1972 1.2.2.2 yamt filter = (struct upgt_lmac_filter *)(mem + 1); 1973 1.2.2.2 yamt 1974 1.2.2.2 yamt filter->header1.flags = UPGT_H1_FLAGS_TX_NO_CALLBACK; 1975 1.2.2.2 yamt filter->header1.type = UPGT_H1_TYPE_CTRL; 1976 1.2.2.2 yamt filter->header1.len = htole16( 1977 1.2.2.2 yamt sizeof(struct upgt_lmac_filter) - 1978 1.2.2.2 yamt sizeof(struct upgt_lmac_header)); 1979 1.2.2.2 yamt 1980 1.2.2.2 yamt filter->header2.reqid = htole32(sc->sc_memaddr_frame_start); 1981 1.2.2.2 yamt filter->header2.type = htole16(UPGT_H2_TYPE_MACFILTER); 1982 1.2.2.2 yamt filter->header2.flags = 0; 1983 1.2.2.2 yamt 1984 1.2.2.2 yamt switch (state) { 1985 1.2.2.2 yamt case IEEE80211_S_INIT: 1986 1.2.2.2 yamt DPRINTF(1, "%s: set MAC filter to INIT\n", 1987 1.2.2.2 yamt device_xname(sc->sc_dev)); 1988 1.2.2.2 yamt 1989 1.2.2.2 yamt filter->type = htole16(UPGT_FILTER_TYPE_RESET); 1990 1.2.2.2 yamt break; 1991 1.2.2.2 yamt case IEEE80211_S_SCAN: 1992 1.2.2.2 yamt DPRINTF(1, "%s: set MAC filter to SCAN (bssid %s)\n", 1993 1.2.2.2 yamt device_xname(sc->sc_dev), ether_sprintf(broadcast)); 1994 1.2.2.2 yamt 1995 1.2.2.2 yamt filter->type = htole16(UPGT_FILTER_TYPE_NONE); 1996 1.2.2.2 yamt IEEE80211_ADDR_COPY(filter->dst, ic->ic_myaddr); 1997 1.2.2.2 yamt IEEE80211_ADDR_COPY(filter->src, broadcast); 1998 1.2.2.2 yamt filter->unknown1 = htole16(UPGT_FILTER_UNKNOWN1); 1999 1.2.2.2 yamt filter->rxaddr = htole32(sc->sc_memaddr_rx_start); 2000 1.2.2.2 yamt filter->unknown2 = htole16(UPGT_FILTER_UNKNOWN2); 2001 1.2.2.2 yamt filter->rxhw = htole32(sc->sc_eeprom_hwrx); 2002 1.2.2.2 yamt filter->unknown3 = htole16(UPGT_FILTER_UNKNOWN3); 2003 1.2.2.2 yamt break; 2004 1.2.2.2 yamt case IEEE80211_S_RUN: 2005 1.2.2.2 yamt DPRINTF(1, "%s: set MAC filter to RUN (bssid %s)\n", 2006 1.2.2.2 yamt device_xname(sc->sc_dev), ether_sprintf(ni->ni_bssid)); 2007 1.2.2.2 yamt 2008 1.2.2.2 yamt filter->type = htole16(UPGT_FILTER_TYPE_STA); 2009 1.2.2.2 yamt IEEE80211_ADDR_COPY(filter->dst, ic->ic_myaddr); 2010 1.2.2.2 yamt IEEE80211_ADDR_COPY(filter->src, ni->ni_bssid); 2011 1.2.2.2 yamt filter->unknown1 = htole16(UPGT_FILTER_UNKNOWN1); 2012 1.2.2.2 yamt filter->rxaddr = htole32(sc->sc_memaddr_rx_start); 2013 1.2.2.2 yamt filter->unknown2 = htole16(UPGT_FILTER_UNKNOWN2); 2014 1.2.2.2 yamt filter->rxhw = htole32(sc->sc_eeprom_hwrx); 2015 1.2.2.2 yamt filter->unknown3 = htole16(UPGT_FILTER_UNKNOWN3); 2016 1.2.2.2 yamt break; 2017 1.2.2.2 yamt default: 2018 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 2019 1.2.2.2 yamt "MAC filter does not know that state\n"); 2020 1.2.2.2 yamt break; 2021 1.2.2.2 yamt } 2022 1.2.2.2 yamt 2023 1.2.2.2 yamt mem->chksum = upgt_chksum_le((uint32_t *)filter, sizeof(*filter)); 2024 1.2.2.2 yamt 2025 1.2.2.2 yamt if (upgt_bulk_xmit(sc, data_cmd, sc->sc_tx_pipeh, &len, 0) != 0) { 2026 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 2027 1.2.2.2 yamt "could not transmit macfilter CMD data URB\n"); 2028 1.2.2.2 yamt return EIO; 2029 1.2.2.2 yamt } 2030 1.2.2.2 yamt 2031 1.2.2.2 yamt return 0; 2032 1.2.2.2 yamt } 2033 1.2.2.2 yamt 2034 1.2.2.2 yamt static int 2035 1.2.2.2 yamt upgt_set_channel(struct upgt_softc *sc, unsigned channel) 2036 1.2.2.2 yamt { 2037 1.2.2.2 yamt struct upgt_data *data_cmd = &sc->cmd_data; 2038 1.2.2.2 yamt struct upgt_lmac_mem *mem; 2039 1.2.2.2 yamt struct upgt_lmac_channel *chan; 2040 1.2.2.2 yamt int len; 2041 1.2.2.2 yamt 2042 1.2.2.2 yamt DPRINTF(1, "%s: %s: %d\n", device_xname(sc->sc_dev), __func__, 2043 1.2.2.2 yamt channel); 2044 1.2.2.2 yamt 2045 1.2.2.2 yamt /* 2046 1.2.2.2 yamt * Transmit the URB containing the CMD data. 2047 1.2.2.2 yamt */ 2048 1.2.2.2 yamt len = sizeof(*mem) + sizeof(*chan); 2049 1.2.2.2 yamt 2050 1.2.2.2 yamt memset(data_cmd->buf, 0, len); 2051 1.2.2.2 yamt 2052 1.2.2.2 yamt mem = (struct upgt_lmac_mem *)data_cmd->buf; 2053 1.2.2.2 yamt mem->addr = htole32(sc->sc_memaddr_frame_start + 2054 1.2.2.2 yamt UPGT_MEMSIZE_FRAME_HEAD); 2055 1.2.2.2 yamt 2056 1.2.2.2 yamt chan = (struct upgt_lmac_channel *)(mem + 1); 2057 1.2.2.2 yamt 2058 1.2.2.2 yamt chan->header1.flags = UPGT_H1_FLAGS_TX_NO_CALLBACK; 2059 1.2.2.2 yamt chan->header1.type = UPGT_H1_TYPE_CTRL; 2060 1.2.2.2 yamt chan->header1.len = htole16( 2061 1.2.2.2 yamt sizeof(struct upgt_lmac_channel) - 2062 1.2.2.2 yamt sizeof(struct upgt_lmac_header)); 2063 1.2.2.2 yamt 2064 1.2.2.2 yamt chan->header2.reqid = htole32(sc->sc_memaddr_frame_start); 2065 1.2.2.2 yamt chan->header2.type = htole16(UPGT_H2_TYPE_CHANNEL); 2066 1.2.2.2 yamt chan->header2.flags = 0; 2067 1.2.2.2 yamt 2068 1.2.2.2 yamt chan->unknown1 = htole16(UPGT_CHANNEL_UNKNOWN1); 2069 1.2.2.2 yamt chan->unknown2 = htole16(UPGT_CHANNEL_UNKNOWN2); 2070 1.2.2.2 yamt chan->freq6 = sc->sc_eeprom_freq6[channel]; 2071 1.2.2.2 yamt chan->settings = sc->sc_eeprom_freq6_settings; 2072 1.2.2.2 yamt chan->unknown3 = UPGT_CHANNEL_UNKNOWN3; 2073 1.2.2.2 yamt 2074 1.2.2.2 yamt memcpy(chan->freq3_1, &sc->sc_eeprom_freq3[channel].data, 2075 1.2.2.2 yamt sizeof(chan->freq3_1)); 2076 1.2.2.2 yamt 2077 1.2.2.2 yamt memcpy(chan->freq4, &sc->sc_eeprom_freq4[channel], 2078 1.2.2.2 yamt sizeof(sc->sc_eeprom_freq4[channel])); 2079 1.2.2.2 yamt 2080 1.2.2.2 yamt memcpy(chan->freq3_2, &sc->sc_eeprom_freq3[channel].data, 2081 1.2.2.2 yamt sizeof(chan->freq3_2)); 2082 1.2.2.2 yamt 2083 1.2.2.2 yamt mem->chksum = upgt_chksum_le((uint32_t *)chan, sizeof(*chan)); 2084 1.2.2.2 yamt 2085 1.2.2.2 yamt if (upgt_bulk_xmit(sc, data_cmd, sc->sc_tx_pipeh, &len, 0) != 0) { 2086 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 2087 1.2.2.2 yamt "could not transmit channel CMD data URB\n"); 2088 1.2.2.2 yamt return EIO; 2089 1.2.2.2 yamt } 2090 1.2.2.2 yamt 2091 1.2.2.2 yamt return 0; 2092 1.2.2.2 yamt } 2093 1.2.2.2 yamt 2094 1.2.2.2 yamt static void 2095 1.2.2.2 yamt upgt_set_led(struct upgt_softc *sc, int action) 2096 1.2.2.2 yamt { 2097 1.2.2.2 yamt struct ieee80211com *ic = &sc->sc_ic; 2098 1.2.2.2 yamt struct upgt_data *data_cmd = &sc->cmd_data; 2099 1.2.2.2 yamt struct upgt_lmac_mem *mem; 2100 1.2.2.2 yamt struct upgt_lmac_led *led; 2101 1.2.2.2 yamt struct timeval t; 2102 1.2.2.2 yamt int len; 2103 1.2.2.2 yamt 2104 1.2.2.2 yamt /* 2105 1.2.2.2 yamt * Transmit the URB containing the CMD data. 2106 1.2.2.2 yamt */ 2107 1.2.2.2 yamt len = sizeof(*mem) + sizeof(*led); 2108 1.2.2.2 yamt 2109 1.2.2.2 yamt memset(data_cmd->buf, 0, len); 2110 1.2.2.2 yamt 2111 1.2.2.2 yamt mem = (struct upgt_lmac_mem *)data_cmd->buf; 2112 1.2.2.2 yamt mem->addr = htole32(sc->sc_memaddr_frame_start + 2113 1.2.2.2 yamt UPGT_MEMSIZE_FRAME_HEAD); 2114 1.2.2.2 yamt 2115 1.2.2.2 yamt led = (struct upgt_lmac_led *)(mem + 1); 2116 1.2.2.2 yamt 2117 1.2.2.2 yamt led->header1.flags = UPGT_H1_FLAGS_TX_NO_CALLBACK; 2118 1.2.2.2 yamt led->header1.type = UPGT_H1_TYPE_CTRL; 2119 1.2.2.2 yamt led->header1.len = htole16( 2120 1.2.2.2 yamt sizeof(struct upgt_lmac_led) - 2121 1.2.2.2 yamt sizeof(struct upgt_lmac_header)); 2122 1.2.2.2 yamt 2123 1.2.2.2 yamt led->header2.reqid = htole32(sc->sc_memaddr_frame_start); 2124 1.2.2.2 yamt led->header2.type = htole16(UPGT_H2_TYPE_LED); 2125 1.2.2.2 yamt led->header2.flags = 0; 2126 1.2.2.2 yamt 2127 1.2.2.2 yamt switch (action) { 2128 1.2.2.2 yamt case UPGT_LED_OFF: 2129 1.2.2.2 yamt led->mode = htole16(UPGT_LED_MODE_SET); 2130 1.2.2.2 yamt led->action_fix = 0; 2131 1.2.2.2 yamt led->action_tmp = htole16(UPGT_LED_ACTION_OFF); 2132 1.2.2.2 yamt led->action_tmp_dur = 0; 2133 1.2.2.2 yamt break; 2134 1.2.2.2 yamt case UPGT_LED_ON: 2135 1.2.2.2 yamt led->mode = htole16(UPGT_LED_MODE_SET); 2136 1.2.2.2 yamt led->action_fix = 0; 2137 1.2.2.2 yamt led->action_tmp = htole16(UPGT_LED_ACTION_ON); 2138 1.2.2.2 yamt led->action_tmp_dur = 0; 2139 1.2.2.2 yamt break; 2140 1.2.2.2 yamt case UPGT_LED_BLINK: 2141 1.2.2.2 yamt if (ic->ic_state != IEEE80211_S_RUN) 2142 1.2.2.2 yamt return; 2143 1.2.2.2 yamt if (sc->sc_led_blink) 2144 1.2.2.2 yamt /* previous blink was not finished */ 2145 1.2.2.2 yamt return; 2146 1.2.2.2 yamt led->mode = htole16(UPGT_LED_MODE_SET); 2147 1.2.2.2 yamt led->action_fix = htole16(UPGT_LED_ACTION_OFF); 2148 1.2.2.2 yamt led->action_tmp = htole16(UPGT_LED_ACTION_ON); 2149 1.2.2.2 yamt led->action_tmp_dur = htole16(UPGT_LED_ACTION_TMP_DUR); 2150 1.2.2.2 yamt /* lock blink */ 2151 1.2.2.2 yamt sc->sc_led_blink = 1; 2152 1.2.2.2 yamt t.tv_sec = 0; 2153 1.2.2.2 yamt t.tv_usec = UPGT_LED_ACTION_TMP_DUR * 1000L; 2154 1.2.2.2 yamt callout_schedule(&sc->led_to, tvtohz(&t)); 2155 1.2.2.2 yamt break; 2156 1.2.2.2 yamt default: 2157 1.2.2.2 yamt return; 2158 1.2.2.2 yamt } 2159 1.2.2.2 yamt 2160 1.2.2.2 yamt mem->chksum = upgt_chksum_le((uint32_t *)led, sizeof(*led)); 2161 1.2.2.2 yamt 2162 1.2.2.2 yamt if (upgt_bulk_xmit(sc, data_cmd, sc->sc_tx_pipeh, &len, 0) != 0) { 2163 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 2164 1.2.2.2 yamt "could not transmit led CMD URB\n"); 2165 1.2.2.2 yamt } 2166 1.2.2.2 yamt } 2167 1.2.2.2 yamt 2168 1.2.2.2 yamt static void 2169 1.2.2.2 yamt upgt_set_led_blink(void *arg) 2170 1.2.2.2 yamt { 2171 1.2.2.2 yamt struct upgt_softc *sc = arg; 2172 1.2.2.2 yamt 2173 1.2.2.2 yamt /* blink finished, we are ready for a next one */ 2174 1.2.2.2 yamt sc->sc_led_blink = 0; 2175 1.2.2.2 yamt callout_stop(&sc->led_to); 2176 1.2.2.2 yamt } 2177 1.2.2.2 yamt 2178 1.2.2.2 yamt static int 2179 1.2.2.2 yamt upgt_get_stats(struct upgt_softc *sc) 2180 1.2.2.2 yamt { 2181 1.2.2.2 yamt struct upgt_data *data_cmd = &sc->cmd_data; 2182 1.2.2.2 yamt struct upgt_lmac_mem *mem; 2183 1.2.2.2 yamt struct upgt_lmac_stats *stats; 2184 1.2.2.2 yamt int len; 2185 1.2.2.2 yamt 2186 1.2.2.2 yamt /* 2187 1.2.2.2 yamt * Transmit the URB containing the CMD data. 2188 1.2.2.2 yamt */ 2189 1.2.2.2 yamt len = sizeof(*mem) + sizeof(*stats); 2190 1.2.2.2 yamt 2191 1.2.2.2 yamt memset(data_cmd->buf, 0, len); 2192 1.2.2.2 yamt 2193 1.2.2.2 yamt mem = (struct upgt_lmac_mem *)data_cmd->buf; 2194 1.2.2.2 yamt mem->addr = htole32(sc->sc_memaddr_frame_start + 2195 1.2.2.2 yamt UPGT_MEMSIZE_FRAME_HEAD); 2196 1.2.2.2 yamt 2197 1.2.2.2 yamt stats = (struct upgt_lmac_stats *)(mem + 1); 2198 1.2.2.2 yamt 2199 1.2.2.2 yamt stats->header1.flags = 0; 2200 1.2.2.2 yamt stats->header1.type = UPGT_H1_TYPE_CTRL; 2201 1.2.2.2 yamt stats->header1.len = htole16( 2202 1.2.2.2 yamt sizeof(struct upgt_lmac_stats) - 2203 1.2.2.2 yamt sizeof(struct upgt_lmac_header)); 2204 1.2.2.2 yamt 2205 1.2.2.2 yamt stats->header2.reqid = htole32(sc->sc_memaddr_frame_start); 2206 1.2.2.2 yamt stats->header2.type = htole16(UPGT_H2_TYPE_STATS); 2207 1.2.2.2 yamt stats->header2.flags = 0; 2208 1.2.2.2 yamt 2209 1.2.2.2 yamt mem->chksum = upgt_chksum_le((uint32_t *)stats, sizeof(*stats)); 2210 1.2.2.2 yamt 2211 1.2.2.2 yamt if (upgt_bulk_xmit(sc, data_cmd, sc->sc_tx_pipeh, &len, 0) != 0) { 2212 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 2213 1.2.2.2 yamt "could not transmit statistics CMD data URB\n"); 2214 1.2.2.2 yamt return EIO; 2215 1.2.2.2 yamt } 2216 1.2.2.2 yamt 2217 1.2.2.2 yamt return 0; 2218 1.2.2.2 yamt 2219 1.2.2.2 yamt } 2220 1.2.2.2 yamt 2221 1.2.2.2 yamt static int 2222 1.2.2.2 yamt upgt_alloc_tx(struct upgt_softc *sc) 2223 1.2.2.2 yamt { 2224 1.2.2.2 yamt int i; 2225 1.2.2.2 yamt 2226 1.2.2.2 yamt sc->tx_queued = 0; 2227 1.2.2.2 yamt 2228 1.2.2.2 yamt for (i = 0; i < UPGT_TX_COUNT; i++) { 2229 1.2.2.2 yamt struct upgt_data *data_tx = &sc->tx_data[i]; 2230 1.2.2.2 yamt 2231 1.2.2.2 yamt data_tx->sc = sc; 2232 1.2.2.2 yamt 2233 1.2.2.2 yamt data_tx->xfer = usbd_alloc_xfer(sc->sc_udev); 2234 1.2.2.2 yamt if (data_tx->xfer == NULL) { 2235 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 2236 1.2.2.2 yamt "could not allocate TX xfer\n"); 2237 1.2.2.2 yamt return ENOMEM; 2238 1.2.2.2 yamt } 2239 1.2.2.2 yamt 2240 1.2.2.2 yamt data_tx->buf = usbd_alloc_buffer(data_tx->xfer, MCLBYTES); 2241 1.2.2.2 yamt if (data_tx->buf == NULL) { 2242 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 2243 1.2.2.2 yamt "could not allocate TX buffer\n"); 2244 1.2.2.2 yamt return ENOMEM; 2245 1.2.2.2 yamt } 2246 1.2.2.2 yamt } 2247 1.2.2.2 yamt 2248 1.2.2.2 yamt return 0; 2249 1.2.2.2 yamt } 2250 1.2.2.2 yamt 2251 1.2.2.2 yamt static int 2252 1.2.2.2 yamt upgt_alloc_rx(struct upgt_softc *sc) 2253 1.2.2.2 yamt { 2254 1.2.2.2 yamt struct upgt_data *data_rx = &sc->rx_data; 2255 1.2.2.2 yamt 2256 1.2.2.2 yamt data_rx->sc = sc; 2257 1.2.2.2 yamt 2258 1.2.2.2 yamt data_rx->xfer = usbd_alloc_xfer(sc->sc_udev); 2259 1.2.2.2 yamt if (data_rx->xfer == NULL) { 2260 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, "could not allocate RX xfer\n"); 2261 1.2.2.2 yamt return ENOMEM; 2262 1.2.2.2 yamt } 2263 1.2.2.2 yamt 2264 1.2.2.2 yamt data_rx->buf = usbd_alloc_buffer(data_rx->xfer, MCLBYTES); 2265 1.2.2.2 yamt if (data_rx->buf == NULL) { 2266 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 2267 1.2.2.2 yamt "could not allocate RX buffer\n"); 2268 1.2.2.2 yamt return ENOMEM; 2269 1.2.2.2 yamt } 2270 1.2.2.2 yamt 2271 1.2.2.2 yamt return 0; 2272 1.2.2.2 yamt } 2273 1.2.2.2 yamt 2274 1.2.2.2 yamt static int 2275 1.2.2.2 yamt upgt_alloc_cmd(struct upgt_softc *sc) 2276 1.2.2.2 yamt { 2277 1.2.2.2 yamt struct upgt_data *data_cmd = &sc->cmd_data; 2278 1.2.2.2 yamt 2279 1.2.2.2 yamt data_cmd->sc = sc; 2280 1.2.2.2 yamt 2281 1.2.2.2 yamt data_cmd->xfer = usbd_alloc_xfer(sc->sc_udev); 2282 1.2.2.2 yamt if (data_cmd->xfer == NULL) { 2283 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, "could not allocate RX xfer\n"); 2284 1.2.2.2 yamt return ENOMEM; 2285 1.2.2.2 yamt } 2286 1.2.2.2 yamt 2287 1.2.2.2 yamt data_cmd->buf = usbd_alloc_buffer(data_cmd->xfer, MCLBYTES); 2288 1.2.2.2 yamt if (data_cmd->buf == NULL) { 2289 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 2290 1.2.2.2 yamt "could not allocate RX buffer\n"); 2291 1.2.2.2 yamt return ENOMEM; 2292 1.2.2.2 yamt } 2293 1.2.2.2 yamt 2294 1.2.2.2 yamt mutex_init(&sc->sc_mtx, MUTEX_DEFAULT, IPL_SOFTNET); 2295 1.2.2.2 yamt 2296 1.2.2.2 yamt return 0; 2297 1.2.2.2 yamt } 2298 1.2.2.2 yamt 2299 1.2.2.2 yamt static void 2300 1.2.2.2 yamt upgt_free_tx(struct upgt_softc *sc) 2301 1.2.2.2 yamt { 2302 1.2.2.2 yamt int i; 2303 1.2.2.2 yamt 2304 1.2.2.2 yamt for (i = 0; i < UPGT_TX_COUNT; i++) { 2305 1.2.2.2 yamt struct upgt_data *data_tx = &sc->tx_data[i]; 2306 1.2.2.2 yamt 2307 1.2.2.2 yamt if (data_tx->xfer != NULL) { 2308 1.2.2.2 yamt usbd_free_xfer(data_tx->xfer); 2309 1.2.2.2 yamt data_tx->xfer = NULL; 2310 1.2.2.2 yamt } 2311 1.2.2.2 yamt 2312 1.2.2.2 yamt data_tx->ni = NULL; 2313 1.2.2.2 yamt } 2314 1.2.2.2 yamt } 2315 1.2.2.2 yamt 2316 1.2.2.2 yamt static void 2317 1.2.2.2 yamt upgt_free_rx(struct upgt_softc *sc) 2318 1.2.2.2 yamt { 2319 1.2.2.2 yamt struct upgt_data *data_rx = &sc->rx_data; 2320 1.2.2.2 yamt 2321 1.2.2.2 yamt if (data_rx->xfer != NULL) { 2322 1.2.2.2 yamt usbd_free_xfer(data_rx->xfer); 2323 1.2.2.2 yamt data_rx->xfer = NULL; 2324 1.2.2.2 yamt } 2325 1.2.2.2 yamt 2326 1.2.2.2 yamt data_rx->ni = NULL; 2327 1.2.2.2 yamt } 2328 1.2.2.2 yamt 2329 1.2.2.2 yamt static void 2330 1.2.2.2 yamt upgt_free_cmd(struct upgt_softc *sc) 2331 1.2.2.2 yamt { 2332 1.2.2.2 yamt struct upgt_data *data_cmd = &sc->cmd_data; 2333 1.2.2.2 yamt 2334 1.2.2.2 yamt if (data_cmd->xfer != NULL) { 2335 1.2.2.2 yamt usbd_free_xfer(data_cmd->xfer); 2336 1.2.2.2 yamt data_cmd->xfer = NULL; 2337 1.2.2.2 yamt } 2338 1.2.2.2 yamt 2339 1.2.2.2 yamt mutex_destroy(&sc->sc_mtx); 2340 1.2.2.2 yamt } 2341 1.2.2.2 yamt 2342 1.2.2.2 yamt static int 2343 1.2.2.2 yamt upgt_bulk_xmit(struct upgt_softc *sc, struct upgt_data *data, 2344 1.2.2.2 yamt usbd_pipe_handle pipeh, uint32_t *size, int flags) 2345 1.2.2.2 yamt { 2346 1.2.2.2 yamt usbd_status status; 2347 1.2.2.2 yamt 2348 1.2.2.2 yamt status = usbd_bulk_transfer(data->xfer, pipeh, 2349 1.2.2.2 yamt USBD_NO_COPY | flags, UPGT_USB_TIMEOUT, data->buf, size, 2350 1.2.2.2 yamt "upgt_bulk_xmit"); 2351 1.2.2.2 yamt if (status != USBD_NORMAL_COMPLETION) { 2352 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, "%s: error %s\n", __func__, 2353 1.2.2.2 yamt usbd_errstr(status)); 2354 1.2.2.2 yamt return EIO; 2355 1.2.2.2 yamt } 2356 1.2.2.2 yamt 2357 1.2.2.2 yamt return 0; 2358 1.2.2.2 yamt } 2359 1.2.2.2 yamt 2360 1.2.2.2 yamt #if 0 2361 1.2.2.2 yamt static void 2362 1.2.2.2 yamt upgt_hexdump(void *buf, int len) 2363 1.2.2.2 yamt { 2364 1.2.2.2 yamt int i; 2365 1.2.2.2 yamt 2366 1.2.2.2 yamt for (i = 0; i < len; i++) { 2367 1.2.2.2 yamt if (i % 16 == 0) 2368 1.2.2.2 yamt printf("%s%5i:", i ? "\n" : "", i); 2369 1.2.2.2 yamt if (i % 4 == 0) 2370 1.2.2.2 yamt printf(" "); 2371 1.2.2.2 yamt printf("%02x", (int)*((uint8_t *)buf + i)); 2372 1.2.2.2 yamt } 2373 1.2.2.2 yamt printf("\n"); 2374 1.2.2.2 yamt } 2375 1.2.2.2 yamt #endif 2376 1.2.2.2 yamt 2377 1.2.2.2 yamt static uint32_t 2378 1.2.2.2 yamt upgt_crc32_le(const void *buf, size_t size) 2379 1.2.2.2 yamt { 2380 1.2.2.2 yamt uint32_t crc; 2381 1.2.2.2 yamt 2382 1.2.2.2 yamt crc = ether_crc32_le(buf, size); 2383 1.2.2.2 yamt 2384 1.2.2.2 yamt /* apply final XOR value as common for CRC-32 */ 2385 1.2.2.2 yamt crc = htole32(crc ^ 0xffffffffU); 2386 1.2.2.2 yamt 2387 1.2.2.2 yamt return crc; 2388 1.2.2.2 yamt } 2389 1.2.2.2 yamt 2390 1.2.2.2 yamt /* 2391 1.2.2.2 yamt * The firmware awaits a checksum for each frame we send to it. 2392 1.2.2.2 yamt * The algorithm used therefor is uncommon but somehow similar to CRC32. 2393 1.2.2.2 yamt */ 2394 1.2.2.2 yamt static uint32_t 2395 1.2.2.2 yamt upgt_chksum_le(const uint32_t *buf, size_t size) 2396 1.2.2.2 yamt { 2397 1.2.2.2 yamt int i; 2398 1.2.2.2 yamt uint32_t crc = 0; 2399 1.2.2.2 yamt 2400 1.2.2.2 yamt for (i = 0; i < size; i += sizeof(uint32_t)) { 2401 1.2.2.2 yamt crc = htole32(crc ^ *buf++); 2402 1.2.2.2 yamt crc = htole32((crc >> 5) ^ (crc << 3)); 2403 1.2.2.2 yamt } 2404 1.2.2.2 yamt 2405 1.2.2.2 yamt return crc; 2406 1.2.2.2 yamt } 2407
Indexes created Fri Oct 03 02:09:57 GMT 2025