Subversion Repositories test_project

/*

 *

 *  Broadcom Blutonium firmware driver

 *

 *  Copyright (C) 2003  Maxim Krasnyansky <maxk@qualcomm.com>

 *  Copyright (C) 2003  Marcel Holtmann <marcel@holtmann.org>

 *

 *

 *  This program is free software; you can redistribute it and/or modify

 *  it under the terms of the GNU General Public License as published by

 *  the Free Software Foundation; either version 2 of the License, or

 *  (at your option) any later version.

 *

 *  This program is distributed in the hope that it will be useful,

 *  but WITHOUT ANY WARRANTY; without even the implied warranty of

 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

 *  GNU General Public License for more details.

 *

 *  You should have received a copy of the GNU General Public License

 *  along with this program; if not, write to the Free Software

 *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA

 *

 */

#include <linux/module.h>

#include <linux/kernel.h>

#include <linux/init.h>

#include <linux/slab.h>

#include <linux/types.h>

#include <linux/errno.h>

#include <linux/device.h>

#include <linux/firmware.h>

#include <linux/usb.h>

#include <net/bluetooth/bluetooth.h>

#ifndef CONFIG_BT_HCIBCM203X_DEBUG

#undef  BT_DBG

#define BT_DBG(D...)

#endif

#define VERSION "1.1"

static int ignore = 0;

static struct usb_device_id bcm203x_table[] = {

        /* Broadcom Blutonium (BCM2033) */

        { USB_DEVICE(0x0a5c, 0x2033) },

        { }     /* Terminating entry */

};

MODULE_DEVICE_TABLE(usb, bcm203x_table);

#define BCM203X_ERROR           0

#define BCM203X_RESET           1

#define BCM203X_LOAD_MINIDRV    2

#define BCM203X_SELECT_MEMORY   3

#define BCM203X_CHECK_MEMORY    4

#define BCM203X_LOAD_FIRMWARE   5

#define BCM203X_CHECK_FIRMWARE  6

#define BCM203X_IN_EP           0x81

#define BCM203X_OUT_EP          0x02

struct bcm203x_data {

        struct usb_device       *udev;

        unsigned long           state;

        struct work_struct      work;

        struct urb              *urb;

        unsigned char           *buffer;

        unsigned char           *fw_data;

        unsigned int            fw_size;

        unsigned int            fw_sent;

};

static void bcm203x_complete(struct urb *urb)

{

        struct bcm203x_data *data = urb->context;

        struct usb_device *udev = urb->dev;

        int len;

        BT_DBG("udev %p urb %p", udev, urb);

        if (urb->status) {

                BT_ERR("URB failed with status %d", urb->status);

                data->state = BCM203X_ERROR;

                return;

        }

        switch (data->state) {

        case BCM203X_LOAD_MINIDRV:

                memcpy(data->buffer, "#", 1);

                usb_fill_bulk_urb(urb, udev, usb_sndbulkpipe(udev, BCM203X_OUT_EP),

                                data->buffer, 1, bcm203x_complete, data);

                data->state = BCM203X_SELECT_MEMORY;

                schedule_work(&data->work);

                break;

        case BCM203X_SELECT_MEMORY:

                usb_fill_int_urb(urb, udev, usb_rcvintpipe(udev, BCM203X_IN_EP),

                                data->buffer, 32, bcm203x_complete, data, 1);

                data->state = BCM203X_CHECK_MEMORY;

                if (usb_submit_urb(data->urb, GFP_ATOMIC) < 0)

                        BT_ERR("Can't submit URB");

                break;

        case BCM203X_CHECK_MEMORY:

                if (data->buffer[0] != '#') {

                        BT_ERR("Memory select failed");

                        data->state = BCM203X_ERROR;

                        break;

                }

                data->state = BCM203X_LOAD_FIRMWARE;

        case BCM203X_LOAD_FIRMWARE:

                if (data->fw_sent == data->fw_size) {

                        usb_fill_int_urb(urb, udev, usb_rcvintpipe(udev, BCM203X_IN_EP),

                                data->buffer, 32, bcm203x_complete, data, 1);

                        data->state = BCM203X_CHECK_FIRMWARE;

                } else {

                        len = min_t(uint, data->fw_size - data->fw_sent, 4096);

                        usb_fill_bulk_urb(urb, udev, usb_sndbulkpipe(udev, BCM203X_OUT_EP),

                                data->fw_data + data->fw_sent, len, bcm203x_complete, data);

                        data->fw_sent += len;

                }

                if (usb_submit_urb(data->urb, GFP_ATOMIC) < 0)

                        BT_ERR("Can't submit URB");

                break;

        case BCM203X_CHECK_FIRMWARE:

                if (data->buffer[0] != '.') {

                        BT_ERR("Firmware loading failed");

                        data->state = BCM203X_ERROR;

                        break;

                }

                data->state = BCM203X_RESET;

                break;

        }

}

static void bcm203x_work(struct work_struct *work)

{

        struct bcm203x_data *data =

                container_of(work, struct bcm203x_data, work);

        if (usb_submit_urb(data->urb, GFP_ATOMIC) < 0)

                BT_ERR("Can't submit URB");

}

static int bcm203x_probe(struct usb_interface *intf, const struct usb_device_id *id)

{

        const struct firmware *firmware;

        struct usb_device *udev = interface_to_usbdev(intf);

        struct bcm203x_data *data;

        int size;

        BT_DBG("intf %p id %p", intf, id);

        if (ignore || (intf->cur_altsetting->desc.bInterfaceNumber != 0))

                return -ENODEV;

        data = kzalloc(sizeof(*data), GFP_KERNEL);

        if (!data) {

                BT_ERR("Can't allocate memory for data structure");

                return -ENOMEM;

        }

        data->udev  = udev;

        data->state = BCM203X_LOAD_MINIDRV;

        data->urb = usb_alloc_urb(0, GFP_KERNEL);

        if (!data->urb) {

                BT_ERR("Can't allocate URB");

                kfree(data);

                return -ENOMEM;

        }

        if (request_firmware(&firmware, "BCM2033-MD.hex", &udev->dev) < 0) {

                BT_ERR("Mini driver request failed");

                usb_free_urb(data->urb);

                kfree(data);

                return -EIO;

        }

        BT_DBG("minidrv data %p size %d", firmware->data, firmware->size);

        size = max_t(uint, firmware->size, 4096);

        data->buffer = kmalloc(size, GFP_KERNEL);

        if (!data->buffer) {

                BT_ERR("Can't allocate memory for mini driver");

                release_firmware(firmware);

                usb_free_urb(data->urb);

                kfree(data);

                return -ENOMEM;

        }

        memcpy(data->buffer, firmware->data, firmware->size);

        usb_fill_bulk_urb(data->urb, udev, usb_sndbulkpipe(udev, BCM203X_OUT_EP),

                        data->buffer, firmware->size, bcm203x_complete, data);

        release_firmware(firmware);

        if (request_firmware(&firmware, "BCM2033-FW.bin", &udev->dev) < 0) {

                BT_ERR("Firmware request failed");

                usb_free_urb(data->urb);

                kfree(data->buffer);

                kfree(data);

                return -EIO;

        }

        BT_DBG("firmware data %p size %d", firmware->data, firmware->size);

        data->fw_data = kmalloc(firmware->size, GFP_KERNEL);

        if (!data->fw_data) {

                BT_ERR("Can't allocate memory for firmware image");

                release_firmware(firmware);

                usb_free_urb(data->urb);

                kfree(data->buffer);

                kfree(data);

                return -ENOMEM;

        }

        memcpy(data->fw_data, firmware->data, firmware->size);

        data->fw_size = firmware->size;

        data->fw_sent = 0;

        release_firmware(firmware);

        INIT_WORK(&data->work, bcm203x_work);

        usb_set_intfdata(intf, data);

        schedule_work(&data->work);

        return 0;

}

static void bcm203x_disconnect(struct usb_interface *intf)

{

        struct bcm203x_data *data = usb_get_intfdata(intf);

        BT_DBG("intf %p", intf);

        usb_kill_urb(data->urb);

        usb_set_intfdata(intf, NULL);

        usb_free_urb(data->urb);

        kfree(data->fw_data);

        kfree(data->buffer);

        kfree(data);

}

static struct usb_driver bcm203x_driver = {

        .name           = "bcm203x",

        .probe          = bcm203x_probe,

        .disconnect     = bcm203x_disconnect,

        .id_table       = bcm203x_table,

};

static int __init bcm203x_init(void)

{

        int err;

        BT_INFO("Broadcom Blutonium firmware driver ver %s", VERSION);

        err = usb_register(&bcm203x_driver);

        if (err < 0)

                BT_ERR("Failed to register USB driver");

        return err;

}

static void __exit bcm203x_exit(void)

{

        usb_deregister(&bcm203x_driver);

}

module_init(bcm203x_init);

module_exit(bcm203x_exit);

module_param(ignore, bool, 0644);

MODULE_PARM_DESC(ignore, "Ignore devices from the matching table");

MODULE_AUTHOR("Marcel Holtmann <marcel@holtmann.org>");

MODULE_DESCRIPTION("Broadcom Blutonium firmware driver ver " VERSION);

MODULE_VERSION(VERSION);

MODULE_LICENSE("GPL");

MODULE_FIRMWARE("BCM2033-MD.hex");

MODULE_FIRMWARE("BCM2033-FW.bin");