Home | History | Annotate | Line # | Download | only in usb
aubtfwl.c revision 1.3
      1  1.3  jakllsch /* $NetBSD: aubtfwl.c,v 1.3 2011/12/23 00:51:43 jakllsch Exp $ */
      2  1.1  jakllsch 
      3  1.1  jakllsch /*
      4  1.1  jakllsch  * Copyright (c) 2011 Jonathan A. Kollasch
      5  1.1  jakllsch  * All rights reserved.
      6  1.1  jakllsch  *
      7  1.1  jakllsch  * Redistribution and use in source and binary forms, with or without
      8  1.1  jakllsch  * modification, are permitted provided that the following conditions
      9  1.1  jakllsch  * are met:
     10  1.1  jakllsch  * 1. Redistributions of source code must retain the above copyright
     11  1.1  jakllsch  *    notice, this list of conditions and the following disclaimer.
     12  1.1  jakllsch  * 2. Redistributions in binary form must reproduce the above copyright
     13  1.1  jakllsch  *    notice, this list of conditions and the following disclaimer in the
     14  1.1  jakllsch  *    documentation and/or other materials provided with the distribution.
     15  1.1  jakllsch  *
     16  1.1  jakllsch  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
     17  1.1  jakllsch  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     18  1.1  jakllsch  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     19  1.1  jakllsch  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE COPYRIGHT HOLDER OR
     20  1.1  jakllsch  * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
     21  1.1  jakllsch  * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
     22  1.1  jakllsch  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
     23  1.1  jakllsch  * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
     24  1.1  jakllsch  * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
     25  1.1  jakllsch  * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
     26  1.1  jakllsch  * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     27  1.1  jakllsch  */
     28  1.1  jakllsch 
     29  1.1  jakllsch #include <sys/cdefs.h>
     30  1.3  jakllsch __KERNEL_RCSID(0, "$NetBSD: aubtfwl.c,v 1.3 2011/12/23 00:51:43 jakllsch Exp $");
     31  1.1  jakllsch 
     32  1.1  jakllsch #include <sys/param.h>
     33  1.1  jakllsch #include <dev/usb/usb.h>
     34  1.1  jakllsch #include <dev/usb/usbdevs.h>
     35  1.1  jakllsch #include <dev/usb/usbdi.h>
     36  1.1  jakllsch #include <dev/usb/usbdi_util.h>
     37  1.1  jakllsch #include <dev/firmload.h>
     38  1.1  jakllsch 
     39  1.1  jakllsch #define AR3K_FIRMWARE_HEADER_SIZE 20
     40  1.1  jakllsch #define AR3K_FIRMWARE_CHUNK_SIZE 4096
     41  1.1  jakllsch 
     42  1.1  jakllsch static int aubtfwl_match(device_t, cfdata_t, void *);
     43  1.1  jakllsch static void aubtfwl_attach(device_t, device_t, void *);
     44  1.1  jakllsch static int aubtfwl_detach(device_t, int);
     45  1.1  jakllsch static void aubtfwl_attach_hook(device_t);
     46  1.1  jakllsch 
     47  1.1  jakllsch struct aubtfwl_softc {
     48  1.1  jakllsch 	usbd_device_handle sc_udev;
     49  1.1  jakllsch };
     50  1.1  jakllsch 
     51  1.1  jakllsch CFATTACH_DECL_NEW(aubtfwl, sizeof(struct aubtfwl_softc), aubtfwl_match, aubtfwl_attach, aubtfwl_detach, NULL);
     52  1.1  jakllsch 
     53  1.1  jakllsch static int
     54  1.1  jakllsch aubtfwl_match(device_t parent, cfdata_t match, void *aux)
     55  1.1  jakllsch {
     56  1.1  jakllsch 	const struct usb_attach_arg * const uaa = aux;
     57  1.1  jakllsch 
     58  1.1  jakllsch 	if (uaa->vendor == USB_VENDOR_ATHEROS2 &&
     59  1.1  jakllsch 	    uaa->product == USB_PRODUCT_ATHEROS2_AR3011)
     60  1.1  jakllsch 		return UMATCH_VENDOR_PRODUCT;
     61  1.1  jakllsch 
     62  1.1  jakllsch 	return UMATCH_NONE;
     63  1.1  jakllsch }
     64  1.1  jakllsch 
     65  1.1  jakllsch static void
     66  1.1  jakllsch aubtfwl_attach(device_t parent, device_t self, void *aux)
     67  1.1  jakllsch {
     68  1.1  jakllsch 	const struct usb_attach_arg * const uaa = aux;
     69  1.1  jakllsch 	struct aubtfwl_softc * const sc = device_private(self);
     70  1.1  jakllsch 	aprint_naive("\n");
     71  1.1  jakllsch 	aprint_normal("\n");
     72  1.1  jakllsch 	sc->sc_udev = uaa->device;
     73  1.1  jakllsch 
     74  1.1  jakllsch 	config_mountroot(self, aubtfwl_attach_hook);
     75  1.1  jakllsch }
     76  1.1  jakllsch 
     77  1.1  jakllsch static int
     78  1.1  jakllsch aubtfwl_detach(device_t self, int flags)
     79  1.1  jakllsch {
     80  1.1  jakllsch 	struct aubtfwl_softc * const sc = device_private(self);
     81  1.1  jakllsch 
     82  1.1  jakllsch 	usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev, self);
     83  1.1  jakllsch 
     84  1.1  jakllsch 	return 0;
     85  1.1  jakllsch }
     86  1.1  jakllsch 
     87  1.1  jakllsch static void
     88  1.1  jakllsch aubtfwl_attach_hook(device_t self)
     89  1.1  jakllsch {
     90  1.1  jakllsch 	struct aubtfwl_softc * const sc = device_private(self);
     91  1.1  jakllsch 	usbd_interface_handle iface;
     92  1.1  jakllsch 	usbd_pipe_handle pipe;
     93  1.1  jakllsch 	usbd_xfer_handle xfer;
     94  1.1  jakllsch 	void *buf;
     95  1.1  jakllsch 	usb_device_request_t req;
     96  1.1  jakllsch 	int error;
     97  1.1  jakllsch 	firmware_handle_t fwh;
     98  1.1  jakllsch 	size_t fws;
     99  1.1  jakllsch 	size_t fwo = 0;
    100  1.1  jakllsch 	uint32_t n;
    101  1.3  jakllsch 
    102  1.1  jakllsch 	memset(&req, 0, sizeof(req));
    103  1.1  jakllsch 
    104  1.1  jakllsch 	error = firmware_open("ubt", "ath3k-1.fw", &fwh); /* XXX revisit name */
    105  1.1  jakllsch 	if (error != 0) {
    106  1.1  jakllsch 		aprint_error_dev(self, "ath3k-1.fw open fail %d\n", error);
    107  1.1  jakllsch 		return;
    108  1.1  jakllsch 	}
    109  1.1  jakllsch 	fws = firmware_get_size(fwh);
    110  1.1  jakllsch 
    111  1.1  jakllsch 	error = usbd_set_config_no(sc->sc_udev, 1, 0);
    112  1.1  jakllsch 	if (error != 0) {
    113  1.1  jakllsch 		aprint_error_dev(self, "could not set configuration no\n");
    114  1.1  jakllsch 		goto out_firmware;
    115  1.1  jakllsch 	}
    116  1.1  jakllsch 
    117  1.1  jakllsch 	error = usbd_device2interface_handle(sc->sc_udev, 0, &iface);
    118  1.1  jakllsch 	if (error) {
    119  1.1  jakllsch 		aprint_error_dev(self, "failed to get interface, %s\n",
    120  1.1  jakllsch 		   usbd_errstr(error));
    121  1.1  jakllsch 		goto out_firmware;
    122  1.1  jakllsch 	}
    123  1.1  jakllsch 
    124  1.1  jakllsch 	error = usbd_open_pipe(iface, UE_DIR_OUT|2, USBD_EXCLUSIVE_USE, &pipe);
    125  1.1  jakllsch 	if (error) {
    126  1.1  jakllsch 		aprint_error_dev(self, "failed to open pipe, %s\n",
    127  1.1  jakllsch 		   usbd_errstr(error));
    128  1.1  jakllsch 		goto out_firmware;
    129  1.1  jakllsch 	}
    130  1.1  jakllsch 
    131  1.1  jakllsch 	xfer = usbd_alloc_xfer(sc->sc_udev);
    132  1.1  jakllsch 	if (xfer == NULL) {
    133  1.1  jakllsch 		aprint_error_dev(self, "failed to alloc xfer\n");
    134  1.1  jakllsch 		goto out_pipe;
    135  1.1  jakllsch 	}
    136  1.1  jakllsch 
    137  1.1  jakllsch 	buf = usbd_alloc_buffer(xfer, 4096);
    138  1.1  jakllsch 	if (buf == NULL) {
    139  1.1  jakllsch 		aprint_error_dev(self, "failed to alloc buffer\n");
    140  1.1  jakllsch 		goto out_xfer;
    141  1.1  jakllsch 	}
    142  1.1  jakllsch 
    143  1.1  jakllsch 	error = firmware_read(fwh, fwo, buf, AR3K_FIRMWARE_HEADER_SIZE);
    144  1.1  jakllsch 	if (error != 0) {
    145  1.1  jakllsch 		aprint_error_dev(self, "firmware_read failed %d\n", error);
    146  1.1  jakllsch 		goto out_xfer;
    147  1.1  jakllsch 	}
    148  1.1  jakllsch 
    149  1.1  jakllsch 	req.bRequest = 1;
    150  1.1  jakllsch 	req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
    151  1.1  jakllsch 	USETW(req.wValue, 0);
    152  1.1  jakllsch 	USETW(req.wIndex, 0);
    153  1.1  jakllsch 	USETW(req.wLength, AR3K_FIRMWARE_HEADER_SIZE);
    154  1.1  jakllsch 
    155  1.1  jakllsch 	aprint_verbose_dev(self, "beginning firmware load\n");
    156  1.1  jakllsch 
    157  1.1  jakllsch 	error = usbd_do_request(sc->sc_udev, &req, buf);
    158  1.1  jakllsch 	if (error != 0) {
    159  1.1  jakllsch 		aprint_error_dev(self, "%s\n", usbd_errstr(error));
    160  1.1  jakllsch 		return;
    161  1.1  jakllsch 	}
    162  1.1  jakllsch 	fwo = AR3K_FIRMWARE_HEADER_SIZE;
    163  1.1  jakllsch 
    164  1.1  jakllsch 	while (fwo < fws) {
    165  1.1  jakllsch 		n = min(AR3K_FIRMWARE_CHUNK_SIZE, fws - fwo);
    166  1.1  jakllsch 		error = firmware_read(fwh, fwo, buf, n);
    167  1.1  jakllsch 		if (error != 0) {
    168  1.1  jakllsch 			break;;
    169  1.1  jakllsch 		}
    170  1.1  jakllsch 		error = usbd_bulk_transfer(xfer, pipe,
    171  1.1  jakllsch 		    USBD_NO_COPY, USBD_DEFAULT_TIMEOUT,
    172  1.1  jakllsch 		    buf, &n, device_xname(self));
    173  1.1  jakllsch 		if (error != USBD_NORMAL_COMPLETION) {
    174  1.1  jakllsch 			aprint_error_dev(self, "xfer failed, %s\n",
    175  1.1  jakllsch 			   usbd_errstr(error));
    176  1.1  jakllsch 			break;;
    177  1.1  jakllsch 		}
    178  1.1  jakllsch 		fwo += n;
    179  1.1  jakllsch 	}
    180  1.1  jakllsch 	aprint_verbose_dev(self, "firmware load complete\n");
    181  1.1  jakllsch 
    182  1.1  jakllsch out_xfer:
    183  1.1  jakllsch 	usbd_free_xfer(xfer);
    184  1.1  jakllsch out_pipe:
    185  1.1  jakllsch 	usbd_close_pipe(pipe);
    186  1.1  jakllsch out_firmware:
    187  1.1  jakllsch 	firmware_close(fwh);
    188  1.1  jakllsch 
    189  1.1  jakllsch 	return;
    190  1.1  jakllsch }
    191