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