root/sys/dev/usb/aubtfwl.c
/* $NetBSD: aubtfwl.c,v 1.10 2020/05/30 17:19:45 jakllsch Exp $ */

/*
 * Copyright (c) 2011 Jonathan A. Kollasch
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 *
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
 * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE COPYRIGHT HOLDER OR
 * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
 * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
 * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
 * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
 * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
 * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */

#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: aubtfwl.c,v 1.10 2020/05/30 17:19:45 jakllsch Exp $");

#include <sys/param.h>
#include <sys/kmem.h>
#include <dev/usb/usb.h>
#include <dev/usb/usbdevs.h>
#include <dev/usb/usbdi.h>
#include <dev/usb/usbdivar.h>
#include <dev/usb/usbdi_util.h>
#include <dev/firmload.h>

#include <dev/usb/aubtfwlreg.h>

#define AR3K_FIRMWARE_CHUNK_SIZE 4096

static int aubtfwl_match(device_t, cfdata_t, void *);
static void aubtfwl_attach(device_t, device_t, void *);
static int aubtfwl_detach(device_t, int);
static void aubtfwl_attach_hook(device_t);

struct aubtfwl_softc {
        struct usbd_device *sc_udev;
        int sc_flags;
#define AUBT_IS_AR3012          1
};

CFATTACH_DECL_NEW(aubtfwl, sizeof(struct aubtfwl_softc), aubtfwl_match, aubtfwl_attach, aubtfwl_detach, NULL);

static const struct usb_devno ar3k_devs[] = {
        { USB_VENDOR_ATHEROS2, USB_PRODUCT_ATHEROS2_AR3011 },
};

static const struct usb_devno ar3k12_devs[] = {
        { USB_VENDOR_FOXCONN, USB_PRODUCT_FOXCONN_AR3012 },
};

static int
aubtfwl_match(device_t parent, cfdata_t match, void *aux)
{
        const struct usb_attach_arg * const uaa = aux;

        if (usb_lookup(ar3k_devs, uaa->uaa_vendor, uaa->uaa_product))
                return UMATCH_VENDOR_PRODUCT;

        if (usb_lookup(ar3k12_devs, uaa->uaa_vendor, uaa->uaa_product)) {
                return (UGETW(uaa->uaa_device->ud_ddesc.bcdDevice) > 1)?
                        UMATCH_NONE : UMATCH_VENDOR_PRODUCT;
        }

        return UMATCH_NONE;
}

static void
aubtfwl_attach(device_t parent, device_t self, void *aux)
{
        const struct usb_attach_arg * const uaa = aux;
        struct aubtfwl_softc * const sc = device_private(self);
        aprint_naive("\n");
        aprint_normal("\n");
        sc->sc_udev = uaa->uaa_device;
        sc->sc_flags = 0;

        if (usb_lookup(ar3k12_devs, uaa->uaa_vendor, uaa->uaa_product))
                sc->sc_flags |= AUBT_IS_AR3012;

        config_mountroot(self, aubtfwl_attach_hook);
}

static int
aubtfwl_detach(device_t self, int flags)
{
        struct aubtfwl_softc * const sc = device_private(self);

        usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev, self);

        return 0;
}

/* Returns 0 if firmware was correctly loaded */
static int
aubtfwl_firmware_load(device_t self, const char *name) {
        struct aubtfwl_softc * const sc = device_private(self);
        struct usbd_interface *iface;
        struct usbd_pipe *pipe;
        struct usbd_xfer *xfer;
        void *buf;
        usb_device_request_t req;
        int error = 0;
        firmware_handle_t fwh;
        size_t fws;
        size_t fwo = 0;
        uint32_t n;

        memset(&req, 0, sizeof(req));

        error = firmware_open("ubt", name, &fwh);
        if (error != 0) {
                aprint_error_dev(self, "'%s' open fail %d\n", name, error);
                return error;
        }
        fws = firmware_get_size(fwh);

        error = usbd_set_config_no(sc->sc_udev, 1, 0);
        if (error != 0) {
                aprint_error_dev(self, "failed to set configuration"
                    ", err=%s\n", usbd_errstr(error));
                goto out_firmware;
        }

        error = usbd_device2interface_handle(sc->sc_udev, 0, &iface);
        if (error) {
                aprint_error_dev(self, "failed to get interface, %s\n",
                   usbd_errstr(error));
                goto out_firmware;
        }

        error = usbd_open_pipe(iface, UE_DIR_OUT|2, USBD_EXCLUSIVE_USE, &pipe);
        if (error) {
                aprint_error_dev(self, "failed to open pipe, %s\n",
                   usbd_errstr(error));
                goto out_firmware;
        }

        error = usbd_create_xfer(pipe, AR3K_FIRMWARE_CHUNK_SIZE, 0, 0, &xfer);
        if (error) {
                aprint_verbose_dev(self, "cannot create xfer(%d)\n",
                    error);
                goto out_pipe;
        }
        buf = usbd_get_buffer(xfer);

        error = firmware_read(fwh, fwo, buf, AR3K_FIRMWARE_HEADER_SIZE);
        if (error != 0) {
                aprint_error_dev(self, "firmware_read failed %d\n", error);
                goto out_xfer;
        }

        req.bRequest = AR3K_SEND_FIRMWARE;
        req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
        USETW(req.wValue, 0);
        USETW(req.wIndex, 0);
        USETW(req.wLength, AR3K_FIRMWARE_HEADER_SIZE);

        aprint_verbose_dev(self, "beginning firmware load\n");

        error = usbd_do_request(sc->sc_udev, &req, buf);
        if (error != 0) {
                aprint_error_dev(self, "%s\n", usbd_errstr(error));
                return error;
        }
        fwo = AR3K_FIRMWARE_HEADER_SIZE;

        while (fwo < fws) {
                n = uimin(AR3K_FIRMWARE_CHUNK_SIZE, fws - fwo);
                error = firmware_read(fwh, fwo, buf, n);
                if (error != 0) {
                        break;
                }
                error = usbd_bulk_transfer(xfer, pipe, 0, USBD_DEFAULT_TIMEOUT,
                    buf, &n);
                if (error != USBD_NORMAL_COMPLETION) {
                        aprint_error_dev(self, "xfer failed, %s\n",
                           usbd_errstr(error));
                        break;
                }
                fwo += n;
        }

        if (error == 0)
                aprint_verbose_dev(self, "firmware load complete\n");

out_xfer:
        usbd_destroy_xfer(xfer);
out_pipe:
        usbd_close_pipe(pipe);
out_firmware:
        firmware_close(fwh);

        return !!error;
}

static int
aubtfwl_get_state(struct aubtfwl_softc *sc, uint8_t *state) {
        usb_device_request_t req;
        int error = 0;

        memset(&req, 0, sizeof(req));

        req.bRequest = AR3K_GET_STATE;
        req.bmRequestType = UT_READ_VENDOR_DEVICE;
        USETW(req.wValue, 0);
        USETW(req.wIndex, 0);
        USETW(req.wLength, sizeof(*state));

        error = usbd_do_request(sc->sc_udev, &req, state);

        return error;
}

static int
aubtfwl_get_version(struct aubtfwl_softc *sc, struct ar3k_version *ver) {
        usb_device_request_t req;
        int error = 0;

        memset(&req, 0, sizeof(req));

        req.bRequest = AR3K_GET_VERSION;
        req.bmRequestType = UT_READ_VENDOR_DEVICE;
        USETW(req.wValue, 0);
        USETW(req.wIndex, 0);
        USETW(req.wLength, sizeof(*ver));

        error = usbd_do_request(sc->sc_udev, &req, ver);

#if BYTE_ORDER == BIG_ENDIAN
        if (error == USBD_NORMAL_COMPLETION) {
                ver->rom = bswap32(ver->rom);
                ver->build = bswap32(ver->build);
                ver->ram = bswap32(ver->ram);
        }
#endif
        return error;
}

static int
aubtfwl_send_command(struct aubtfwl_softc *sc, uByte cmd) {
        usb_device_request_t req;
        int error = 0;

        memset(&req, 0, sizeof(req));

        req.bRequest = cmd;
        req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
        USETW(req.wValue, 0);
        USETW(req.wIndex, 0);
        USETW(req.wLength, 0);

        error = usbd_do_request(sc->sc_udev, &req, NULL);

        return error;
}

static void
aubtfwl_attach_hook(device_t self)
{
        struct aubtfwl_softc * const sc = device_private(self);
        char *fw_name;
        struct ar3k_version ver;
        uint8_t state;
        int clock = 0;
        int error = 0;

        if (sc->sc_flags & AUBT_IS_AR3012) {
                error = aubtfwl_get_version(sc, &ver);
                if (!error)
                        error = aubtfwl_get_state(sc, &state);

                if (error) {
                        aprint_error_dev(self,
                                "couldn't get version or state\n");
                        return;
                }

                aprint_verbose_dev(self, "state is 0x%02x\n", state);

                if (!(state & AR3K_STATE_IS_PATCHED)) {
                        fw_name = kmem_asprintf("ar3k/AthrBT_0x%08x.dfu",
                            ver.rom);
                        error = aubtfwl_firmware_load(self, fw_name);
                        kmem_strfree(fw_name);

                        if (error)
                                return;
                }

                switch (ver.clock) {
                case AR3K_CLOCK_19M:
                        clock = 19;
                        break;
                case AR3K_CLOCK_26M:
                        clock = 26;
                        break;
                case AR3K_CLOCK_40M:
                        clock = 40;
                        break;
                }

                fw_name = kmem_asprintf("ar3k/ramps_0x%08x_%d.dfu",
                    ver.rom, clock);
                aubtfwl_firmware_load(self, fw_name);
                kmem_strfree(fw_name);

                if ((state & AR3K_STATE_MODE_MASK) != AR3K_STATE_MODE_NORMAL) {
                        error = aubtfwl_send_command(sc, AR3K_SET_NORMAL_MODE);
                        if (error) {
                                aprint_error_dev(self,
                                        "couldn't set normal mode: %s",
                                        usbd_errstr(error));
                                return;
                        }
                }

                /* Apparently some devices will fail this, so ignore result */
                (void) aubtfwl_send_command(sc, AR3K_SWITCH_VID_PID);
        } else {
                aubtfwl_firmware_load(self, "ath3k-1.fw");
        }

        return;
}