/**
 * aicwf_usb.c
 *
 * USB function declarations
 *
 * Copyright (C) AICSemi 2018-2020
 */
#include <linux/kthread.h>
#include <linux/netdevice.h>
#include <linux/printk.h>
#include <linux/interrupt.h>
#include <linux/sched.h>
#include <linux/completion.h>
#include <linux/semaphore.h>
#include <linux/debugfs.h>
#include <linux/atomic.h>
#include <linux/vmalloc.h>
#include <linux/signal.h>

#include <linux/usb.h>
#include <linux/kthread.h>
#include <linux/version.h>
#include "aic_txrxif.h"
#include "aicwf_usb.h"
#include "aicbluetooth.h"
#include "aicwf_debug.h"
#include "aic_compat_8800d80.h"
#include "aic_compat_8800d80x2.h"

#define JUMP_TABLE_BASE   0x161928
#define JUMP_TABLE_OFFSET(i) ((u32)(JUMP_TABLE_BASE+(i)*4))
extern int adap_test;
extern int testmode;
extern unsigned char paringid[100];
extern int ble_scan_wakeup_reboot_time;
extern uint32_t ad_data_filter_mask;
extern uint32_t gpio_num;//default select gpiob2 for fw_wakeup_host
extern uint32_t gpio_dft_lvl;//0:defalut pull down,  1:default pull up
u8 chip_id = 0;
u8 chip_sub_id = 0;
u8 chip_mcu_id = 0;
int fw_loaded = 0;

void aicwf_usb_tx_flowctrl(struct aic_usb_dev *usb_dev, bool state)
{
}

static struct aicwf_usb_buf *aicwf_usb_tx_dequeue(struct aic_usb_dev *usb_dev,
    struct list_head *q, int *counter, spinlock_t *qlock)
{
    unsigned long flags;
    struct aicwf_usb_buf *usb_buf;

    spin_lock_irqsave(qlock, flags);
    if (list_empty(q)) {
        usb_buf = NULL;
    } else {
        usb_buf = list_first_entry(q, struct aicwf_usb_buf, list);
        list_del_init(&usb_buf->list);
        if (counter)
            (*counter)--;
    }
    spin_unlock_irqrestore(qlock, flags);
    return usb_buf;
}

static void aicwf_usb_tx_queue(struct aic_usb_dev *usb_dev,
    struct list_head *q, struct aicwf_usb_buf *usb_buf, int *counter,
    spinlock_t *qlock)
{
    unsigned long flags;

    spin_lock_irqsave(qlock, flags);
    list_add_tail(&usb_buf->list, q);
    (*counter)++;
    spin_unlock_irqrestore(qlock, flags);
}

static struct aicwf_usb_buf *aicwf_usb_rx_buf_get(struct aic_usb_dev *usb_dev)
{
    unsigned long flags;
    struct aicwf_usb_buf *usb_buf;

    spin_lock_irqsave(&usb_dev->rx_free_lock, flags);
    if (list_empty(&usb_dev->rx_free_list)) {
        usb_buf = NULL;
    } else {
        usb_buf = list_first_entry(&usb_dev->rx_free_list, struct aicwf_usb_buf, list);
        list_del_init(&usb_buf->list);
    }
    spin_unlock_irqrestore(&usb_dev->rx_free_lock, flags);
    return usb_buf;
}

static void aicwf_usb_rx_buf_put(struct aic_usb_dev *usb_dev, struct aicwf_usb_buf *usb_buf)
{
    unsigned long flags;

    spin_lock_irqsave(&usb_dev->rx_free_lock, flags);
    list_add_tail(&usb_buf->list, &usb_dev->rx_free_list);
    spin_unlock_irqrestore(&usb_dev->rx_free_lock, flags);
}

static void aicwf_usb_tx_complete(struct urb *urb)
{
    unsigned long flags;
    struct aicwf_usb_buf *usb_buf = (struct aicwf_usb_buf *) urb->context;
    struct aic_usb_dev *usb_dev = usb_buf->usbdev;
    struct sk_buff *skb;

    if (usb_buf->cfm == false) {
        skb = usb_buf->skb;
        dev_kfree_skb_any(skb);
    }
    #if !defined CONFIG_USB_NO_TRANS_DMA_MAP
    else {
        u8 *buf;
        buf = (u8 *)usb_buf->skb;
        kfree(buf);
    }
    #endif
    usb_buf->skb = NULL;

    aicwf_usb_tx_queue(usb_dev, &usb_dev->tx_free_list, usb_buf,
                    &usb_dev->tx_free_count, &usb_dev->tx_free_lock);

    spin_lock_irqsave(&usb_dev->tx_flow_lock, flags);
    if (usb_dev->tx_free_count > AICWF_USB_TX_HIGH_WATER) {
        if (usb_dev->tbusy) {
            usb_dev->tbusy = false;
            aicwf_usb_tx_flowctrl(usb_dev, false);
        }
    }
    spin_unlock_irqrestore(&usb_dev->tx_flow_lock, flags);
    }

static void aicwf_usb_rx_complete(struct urb *urb)
{
    struct aicwf_usb_buf *usb_buf = (struct aicwf_usb_buf *) urb->context;
    struct aic_usb_dev *usb_dev = usb_buf->usbdev;
    struct aicwf_rx_priv* rx_priv = usb_dev->rx_priv;
    struct sk_buff *skb = NULL;
    unsigned long flags = 0;

    skb = usb_buf->skb;
    usb_buf->skb = NULL;

    if (urb->actual_length > urb->transfer_buffer_length) {
        aicwf_dev_skb_free(skb);
        aicwf_usb_rx_buf_put(usb_dev, usb_buf);
        schedule_work(&usb_dev->rx_urb_work);
        return;
    }

    if (urb->status != 0 || !urb->actual_length) {
        aicwf_dev_skb_free(skb);
        aicwf_usb_rx_buf_put(usb_dev, usb_buf);
        schedule_work(&usb_dev->rx_urb_work);
        return;
    }

    if (usb_dev->state == USB_UP_ST) {
        skb_put(skb, urb->actual_length);

        spin_lock_irqsave(&rx_priv->rxqlock, flags);
        if(!aicwf_rxframe_enqueue(usb_dev->dev, &rx_priv->rxq, skb)){
            spin_unlock_irqrestore(&rx_priv->rxqlock, flags);
            usb_err("rx_priv->rxq is over flow!!!\n");
            aicwf_dev_skb_free(skb);
            return;
        }
        spin_unlock_irqrestore(&rx_priv->rxqlock, flags);
        atomic_inc(&rx_priv->rx_cnt);
        complete(&rx_priv->usbdev->bus_if->busrx_trgg);
        aicwf_usb_rx_buf_put(usb_dev, usb_buf);

        schedule_work(&usb_dev->rx_urb_work);
    } else {
        aicwf_dev_skb_free(skb);
        aicwf_usb_rx_buf_put(usb_dev, usb_buf);
    }
}

static int aicwf_usb_submit_rx_urb(struct aic_usb_dev *usb_dev,
                struct aicwf_usb_buf *usb_buf)
{
    struct sk_buff *skb;
    int ret;

    if (!usb_buf || !usb_dev)
        return -1;

    if (usb_dev->state != USB_UP_ST) {
        usb_err("usb state is not up!\n");
        aicwf_usb_rx_buf_put(usb_dev, usb_buf);
        return -1;
    }

    skb = __dev_alloc_skb(AICWF_USB_MAX_PKT_SIZE, GFP_KERNEL);
    if (!skb) {
        aicwf_usb_rx_buf_put(usb_dev, usb_buf);
        return -1;
    }

    usb_buf->skb = skb;

    usb_fill_bulk_urb(usb_buf->urb,
        usb_dev->udev,
        usb_dev->bulk_in_pipe,
        skb->data, skb_tailroom(skb), aicwf_usb_rx_complete, usb_buf);

    usb_buf->usbdev = usb_dev;

    usb_anchor_urb(usb_buf->urb, &usb_dev->rx_submitted);

    ret = usb_submit_urb(usb_buf->urb, GFP_ATOMIC);
    if (ret) {
        usb_err("usb submit rx urb fail:%d\n", ret);
        usb_unanchor_urb(usb_buf->urb);
        aicwf_dev_skb_free(usb_buf->skb);
        usb_buf->skb = NULL;
        aicwf_usb_rx_buf_put(usb_dev, usb_buf);
        msleep(100);
		return ret;
    }
    return 0;
}

static void aicwf_usb_rx_submit_all_urb(struct aic_usb_dev *usb_dev)
{
    struct aicwf_usb_buf *usb_buf;

    if (usb_dev->state != USB_UP_ST) {
        usb_err("bus is not up=%d\n", usb_dev->state);
        return;
    }
    if (usb_dev->app_cmp) {
        printk("app_cmp\r\n");
        return;
}

    while((usb_buf = aicwf_usb_rx_buf_get(usb_dev)) != NULL) {
        if (aicwf_usb_submit_rx_urb(usb_dev, usb_buf)) {
            usb_err("usb rx refill fail\n");
            if (usb_dev->state != USB_UP_ST){
                return;
            }
			break;
		}
    }
}

static void aicwf_usb_rx_prepare(struct aic_usb_dev *usb_dev)
{
    aicwf_usb_rx_submit_all_urb(usb_dev);
}

static void aicwf_usb_tx_prepare(struct aic_usb_dev *usb_dev)
{
    struct aicwf_usb_buf *usb_buf;

    while(!list_empty(&usb_dev->tx_post_list)){
        usb_buf = aicwf_usb_tx_dequeue(usb_dev, &usb_dev->tx_post_list,
            &usb_dev->tx_post_count, &usb_dev->tx_post_lock);
        if(usb_buf->skb) {
            dev_kfree_skb(usb_buf->skb);
            usb_buf->skb = NULL;
        }
        aicwf_usb_tx_queue(usb_dev, &usb_dev->tx_free_list, usb_buf,
                &usb_dev->tx_free_count, &usb_dev->tx_free_lock);
    }
}
static void aicwf_usb_tx_process(struct aic_usb_dev *usb_dev)
{
    struct aicwf_usb_buf *usb_buf;
    int ret = 0;
    u8* data = NULL;

    while(!list_empty(&usb_dev->tx_post_list)) {
        if (usb_dev->state != USB_UP_ST) {
            usb_err("usb state is not up!\n");
            return;
        }

        usb_buf = aicwf_usb_tx_dequeue(usb_dev, &usb_dev->tx_post_list,
                        &usb_dev->tx_post_count, &usb_dev->tx_post_lock);
        if(!usb_buf) {
            usb_err("can not get usb_buf from tx_post_list!\n");
            return;
        }
        data = usb_buf->skb->data;

        ret = usb_submit_urb(usb_buf->urb, GFP_ATOMIC);
        if (ret) {
            usb_err("aicwf_usb_bus_tx usb_submit_urb FAILED\n");
            goto fail;
        }

        continue;
fail:
        dev_kfree_skb(usb_buf->skb);
        usb_buf->skb = NULL;
        aicwf_usb_tx_queue(usb_dev, &usb_dev->tx_free_list, usb_buf,
                    &usb_dev->tx_free_count, &usb_dev->tx_free_lock);
    }
}

static inline void aic_thread_wait_stop(void)
{
#if 1// PLATFORM_LINUX
	#if 0
	while (!kthread_should_stop())
		rtw_msleep_os(10);
	#else
	set_current_state(TASK_INTERRUPTIBLE);
	while (!kthread_should_stop()) {
		schedule();
		set_current_state(TASK_INTERRUPTIBLE);
	}
	__set_current_state(TASK_RUNNING);
	#endif
#endif
}

int usb_bustx_thread(void *data)
{
    struct aicwf_bus *bus = (struct aicwf_bus *)data;
    struct aic_usb_dev *usbdev = bus->bus_priv.usb;

    while (1) {
		/*
        if(kthread_should_stop()) {
            usb_err("usb bustx thread stop\n");
            break;
        }
        */

        if (!wait_for_completion_interruptible(&bus->bustx_trgg)) {
			if (usbdev->app_cmp == false){
				printk("usb bustx thread will to stop\n");
				//mdelay(100);
				break;
				//continue;
			}
            if (usbdev->tx_post_count > 0)
                aicwf_usb_tx_process(usbdev);
        }
    }

	aic_thread_wait_stop();
	printk("usb bustx thread stop\n");

    return 0;
}

int usb_busrx_thread(void *data)
{
    struct aicwf_rx_priv *rx_priv = (struct aicwf_rx_priv *)data;
    struct aicwf_bus *bus_if = rx_priv->usbdev->bus_if;

    allow_signal(SIGTERM);
    while (1) {
        #if 0
		if(kthread_should_stop()) {
            usb_err("usb busrx thread stop\n");
            break;
        }
		#endif
        if (!wait_for_completion_interruptible(&bus_if->busrx_trgg)) {
            aicwf_process_rxframes(rx_priv);
        } else {
            break;
        }
        if (bus_if->state == BUS_DOWN_ST) {
            printk("usb busrx thread will to stop\n");
            break;
        }

    }
	aic_thread_wait_stop();
    printk("usb busrx thread stop\n");

    return 0;
}

static void aicwf_usb_send_msg_complete(struct urb *urb)
{
    struct aic_usb_dev *usb_dev = (struct aic_usb_dev *) urb->context;

    usb_dev->msg_finished = true;
    if (waitqueue_active(&usb_dev->msg_wait))
        wake_up(&usb_dev->msg_wait);
}

static int aicwf_usb_bus_txmsg(struct device *dev, u8 *buf, u32 len)
{
    int ret = 0;
    struct aicwf_bus *bus_if = dev_get_drvdata(dev);
    struct aic_usb_dev *usb_dev = bus_if->bus_priv.usb;

    if (usb_dev->state != USB_UP_ST)
        return -EIO;

    if (buf == NULL || len == 0 || usb_dev->msg_out_urb == NULL)
        return -EINVAL;

    if (test_and_set_bit(0, &usb_dev->msg_busy)) {
        usb_err("In a control frame option, can't tx!\n");
        return -EIO;
    }

    usb_dev->msg_finished = false;

#ifdef CONFIG_USB_MSG_EP
		if (usb_dev->msg_out_pipe && usb_dev->use_msg_ep == 1) {
			usb_fill_bulk_urb(usb_dev->msg_out_urb,
				usb_dev->udev,
				usb_dev->msg_out_pipe,
				buf, len, (usb_complete_t) aicwf_usb_send_msg_complete, usb_dev);
		} else {
			usb_fill_bulk_urb(usb_dev->msg_out_urb,
				usb_dev->udev,
				usb_dev->bulk_out_pipe,
				buf, len, (usb_complete_t) aicwf_usb_send_msg_complete, usb_dev);
		}
#else
    usb_fill_bulk_urb(usb_dev->msg_out_urb,
        usb_dev->udev,
        usb_dev->bulk_out_pipe,
        buf, len, (usb_complete_t) aicwf_usb_send_msg_complete, usb_dev);
#endif
    #if defined CONFIG_USB_NO_TRANS_DMA_MAP
    usb_dev->msg_out_urb->transfer_dma = usb_dev->cmd_dma_trans_addr;
    usb_dev->msg_out_urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
    #endif
    usb_dev->msg_out_urb->transfer_flags |= URB_ZERO_PACKET;

    ret = usb_submit_urb(usb_dev->msg_out_urb, GFP_ATOMIC);
    if (ret) {
        usb_err("usb_submit_urb failed %d\n", ret);
        goto exit;
    }

    ret = wait_event_timeout(usb_dev->msg_wait,
        usb_dev->msg_finished, msecs_to_jiffies(CMD_TX_TIMEOUT));
    if (!ret) {
        if (usb_dev->msg_out_urb)
            usb_kill_urb(usb_dev->msg_out_urb);
        usb_err("Txmsg wait timed out\n");
        ret = -EIO;
        goto exit;
    }

    if (usb_dev->msg_finished == false) {
        usb_err("Txmsg timed out\n");
        ret = -ETIMEDOUT;
        goto exit;
    }
exit:
    clear_bit(0, &usb_dev->msg_busy);
    return ret;
}


static void aicwf_usb_free_urb(struct list_head *q, spinlock_t *qlock)
{
    struct aicwf_usb_buf *usb_buf, *tmp;
    unsigned long flags;

    spin_lock_irqsave(qlock, flags);
    list_for_each_entry_safe(usb_buf, tmp, q, list) {
    spin_unlock_irqrestore(qlock, flags);
        if (!usb_buf->urb) {
            usb_err("bad usb_buf\n");
            spin_lock_irqsave(qlock, flags);
            break;
        }
        usb_free_urb(usb_buf->urb);
        list_del_init(&usb_buf->list);
        spin_lock_irqsave(qlock, flags);
    }
    spin_unlock_irqrestore(qlock, flags);
}

static int aicwf_usb_alloc_rx_urb(struct aic_usb_dev *usb_dev)
{
    int i;

    for (i = 0; i < AICWF_USB_RX_URBS; i++) {
        struct aicwf_usb_buf *usb_buf = &usb_dev->usb_rx_buf[i];

        usb_buf->usbdev = usb_dev;
        usb_buf->urb = usb_alloc_urb(0, GFP_KERNEL);
        if (!usb_buf->urb) {
            usb_err("could not allocate rx data urb\n");
            goto err;
        }
        #if defined CONFIG_USB_NO_TRANS_DMA_MAP
        // dma buf unused
        usb_buf->data_buf = NULL;
        usb_buf->data_dma_trans_addr = 0x0;
        #endif
        list_add_tail(&usb_buf->list, &usb_dev->rx_free_list);
    }
    return 0;

err:
    aicwf_usb_free_urb(&usb_dev->rx_free_list, &usb_dev->rx_free_lock);
    return -ENOMEM;
}

static int aicwf_usb_alloc_tx_urb(struct aic_usb_dev *usb_dev)
{
    int i;

    for (i = 0; i < AICWF_USB_TX_URBS; i++) {
        struct aicwf_usb_buf *usb_buf = &usb_dev->usb_tx_buf[i];

        usb_buf->usbdev = usb_dev;
        usb_buf->urb = usb_alloc_urb(0, GFP_KERNEL);
        if (!usb_buf->urb) {
            usb_err("could not allocate tx data urb\n");
            goto err;
        }
        #if defined CONFIG_USB_NO_TRANS_DMA_MAP
        // dma buf unused
        usb_buf->data_buf = NULL;
        usb_buf->data_dma_trans_addr = 0x0;
        #endif
        list_add_tail(&usb_buf->list, &usb_dev->tx_free_list);
        (usb_dev->tx_free_count)++;
    }
    return 0;

err:
    aicwf_usb_free_urb(&usb_dev->tx_free_list, &usb_dev->tx_free_lock);
    return -ENOMEM;
}


static void aicwf_usb_state_change(struct aic_usb_dev *usb_dev, int state)
{
    int old_state;

    if (usb_dev->state == state)
        return;

    old_state = usb_dev->state;
    usb_dev->state = state;

    if (state == USB_DOWN_ST) {
        usb_dev->bus_if->state = BUS_DOWN_ST;
    }
    if (state == USB_UP_ST) {
        usb_dev->bus_if->state = BUS_UP_ST;
    }
}

static int aicwf_usb_bus_txdata(struct device *dev, struct sk_buff *skb)
{
    u8 *buf = NULL;
    u16 buf_len = 0;
    struct aicwf_usb_buf *usb_buf;
    int ret = 0;
    unsigned long flags;
    struct aicwf_bus *bus_if = dev_get_drvdata(dev);
    struct aic_usb_dev *usb_dev = bus_if->bus_priv.usb;
    bool need_cfm = false;

    if (usb_dev->state != USB_UP_ST) {
        usb_err("usb state is not up!\n");
        dev_kfree_skb_any(skb);
        return -EIO;
    }

    usb_buf = aicwf_usb_tx_dequeue(usb_dev, &usb_dev->tx_free_list,
                        &usb_dev->tx_free_count, &usb_dev->tx_free_lock);
    if (!usb_buf) {
        usb_err("free:%d, post:%d\n", usb_dev->tx_free_count, usb_dev->tx_post_count);
        dev_kfree_skb_any(skb);
        ret = -ENOMEM;
        goto flow_ctrl;
    }

    usb_buf->usbdev = usb_dev;
    if (need_cfm)
        usb_buf->cfm = true;
    else
        usb_buf->cfm = false;
    usb_fill_bulk_urb(usb_buf->urb, usb_dev->udev, usb_dev->bulk_out_pipe,
                buf, buf_len, aicwf_usb_tx_complete, usb_buf);
    #if defined CONFIG_USB_NO_TRANS_DMA_MAP
    usb_buf->urb->transfer_dma = usb_buf->data_dma_trans_addr;
    usb_buf->urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
    #endif
    usb_buf->urb->transfer_flags |= URB_ZERO_PACKET;

    aicwf_usb_tx_queue(usb_dev, &usb_dev->tx_post_list, usb_buf,
                    &usb_dev->tx_post_count, &usb_dev->tx_post_lock);
    complete(&bus_if->bustx_trgg);
    ret = 0;

    flow_ctrl:
    spin_lock_irqsave(&usb_dev->tx_flow_lock, flags);
    if (usb_dev->tx_free_count < AICWF_USB_TX_LOW_WATER) {
        usb_dev->tbusy = true;
        aicwf_usb_tx_flowctrl(usb_dev, true);
    }
    spin_unlock_irqrestore(&usb_dev->tx_flow_lock, flags);

    return ret;
}

static int aicwf_usb_bus_start(struct device *dev)
{
    struct aicwf_bus *bus_if = dev_get_drvdata(dev);
    struct aic_usb_dev *usb_dev = bus_if->bus_priv.usb;

    if (usb_dev->state == USB_UP_ST)
        return 0;

    aicwf_usb_state_change(usb_dev, USB_UP_ST);
    aicwf_usb_rx_prepare(usb_dev);
    aicwf_usb_tx_prepare(usb_dev);
    return 0;
}

static void aicwf_usb_cancel_all_urbs(struct aic_usb_dev *usb_dev)
{
    struct aicwf_usb_buf *usb_buf, *tmp;
    unsigned long flags;

    if (usb_dev->msg_out_urb)
        usb_kill_urb(usb_dev->msg_out_urb);

    spin_lock_irqsave(&usb_dev->tx_post_lock, flags);
    list_for_each_entry_safe(usb_buf, tmp, &usb_dev->tx_post_list, list) {
        spin_unlock_irqrestore(&usb_dev->tx_post_lock, flags);
        if (!usb_buf->urb) {
            usb_err("bad usb_buf\n");
            spin_lock_irqsave(&usb_dev->tx_post_lock, flags);
            break;
        }
        usb_kill_urb(usb_buf->urb);
        spin_lock_irqsave(&usb_dev->tx_post_lock, flags);
    }
    spin_unlock_irqrestore(&usb_dev->tx_post_lock, flags);

    usb_kill_anchored_urbs(&usb_dev->rx_submitted);
}

static void aicwf_usb_bus_stop(struct device *dev)
{
    struct aicwf_bus *bus_if = dev_get_drvdata(dev);
    struct aic_usb_dev *usb_dev = bus_if->bus_priv.usb;

    if (usb_dev == NULL)
        return;

    if (usb_dev->state == USB_DOWN_ST)
        return;

    aicwf_usb_state_change(usb_dev, USB_DOWN_ST);
    aicwf_usb_cancel_all_urbs(usb_dev);
}

static void aicwf_usb_deinit(struct aic_usb_dev *usbdev)
{
    cancel_work_sync(&usbdev->rx_urb_work);
    aicwf_usb_free_urb(&usbdev->rx_free_list, &usbdev->rx_free_lock);
    aicwf_usb_free_urb(&usbdev->tx_free_list, &usbdev->tx_free_lock);
	aicwf_usb_free_urb(&usbdev->tx_post_list, &usbdev->tx_post_lock);
    usb_free_urb(usbdev->msg_out_urb);
}

static void aicwf_usb_rx_urb_work(struct work_struct *work)
{
    struct aic_usb_dev *usb_dev = container_of(work, struct aic_usb_dev, rx_urb_work);

    aicwf_usb_rx_submit_all_urb(usb_dev);
}

static int aicwf_usb_init(struct aic_usb_dev *usb_dev)
{
    int ret = 0;

    usb_dev->tbusy = false;
    usb_dev->app_cmp = false;
    usb_dev->state = USB_DOWN_ST;

    init_waitqueue_head(&usb_dev->msg_wait);
    init_usb_anchor(&usb_dev->rx_submitted);

    spin_lock_init(&usb_dev->tx_free_lock);
    spin_lock_init(&usb_dev->tx_post_lock);
    spin_lock_init(&usb_dev->rx_free_lock);
    spin_lock_init(&usb_dev->tx_flow_lock);

    INIT_LIST_HEAD(&usb_dev->rx_free_list);
    INIT_LIST_HEAD(&usb_dev->tx_free_list);
    INIT_LIST_HEAD(&usb_dev->tx_post_list);

    usb_dev->tx_free_count = 0;
    usb_dev->tx_post_count = 0;

    ret =  aicwf_usb_alloc_rx_urb(usb_dev);
    if (ret) {
        goto error;
    }
    ret =  aicwf_usb_alloc_tx_urb(usb_dev);
    if (ret) {
        goto error;
    }


    usb_dev->msg_out_urb = usb_alloc_urb(0, GFP_ATOMIC);
    if (!usb_dev->msg_out_urb) {
        usb_err("usb_alloc_urb (msg out) failed\n");
        ret = ENOMEM;
        goto error;
    }

    INIT_WORK(&usb_dev->rx_urb_work, aicwf_usb_rx_urb_work);

    return ret;
    error:
    usb_err("failed!\n");
    aicwf_usb_deinit(usb_dev);
    return ret;
}

static int aicwf_parse_usb(struct aic_usb_dev *usb_dev, struct usb_interface *interface, int pid)
{
    struct usb_interface_descriptor *interface_desc;
    struct usb_host_interface *host_interface;
    struct usb_endpoint_descriptor *endpoint;
    struct usb_device *usb = usb_dev->udev;
    int i, endpoints;
    u8 endpoint_num;
    int ret = 0;

    usb_dev->bulk_in_pipe = 0;
    usb_dev->bulk_out_pipe = 0;
#ifdef CONFIG_USB_MSG_EP
	usb_dev->msg_out_pipe = 0;
#endif


    host_interface = &interface->altsetting[0];
    interface_desc = &host_interface->desc;
    endpoints = interface_desc->bNumEndpoints;

    /* Check device configuration */
    if (usb->descriptor.bNumConfigurations != 1) {
        usb_err("Number of configurations: %d not supported\n",
                        usb->descriptor.bNumConfigurations);
        ret = -ENODEV;
        goto exit;
    }

    /* Check deviceclass */
    if (usb->descriptor.bDeviceClass != 0x00 && usb->descriptor.bDeviceClass != 239) {
        usb_err("DeviceClass %d not supported\n",
            usb->descriptor.bDeviceClass);
        ret = -ENODEV;
        goto exit;
    }

    /* Check interface number */
    if (usb->actconfig->desc.bNumInterfaces != 1 && usb->actconfig->desc.bNumInterfaces != 3) {
        usb_err("Number of interfaces: %d not supported\n",
            usb->actconfig->desc.bNumInterfaces);
        ret = -ENODEV;
        goto exit;
    }

    if ((interface_desc->bInterfaceClass != USB_CLASS_VENDOR_SPEC) ||
        (interface_desc->bInterfaceSubClass != 0xff) ||
        (interface_desc->bInterfaceProtocol != 0xff)) {
        usb_err("non WLAN interface %d: 0x%x:0x%x:0x%x\n",
            interface_desc->bInterfaceNumber, interface_desc->bInterfaceClass,
            interface_desc->bInterfaceSubClass, interface_desc->bInterfaceProtocol);
        ret = -ENODEV;
        goto exit;
    }

    for (i = 0; i < endpoints; i++) {
        endpoint = &host_interface->endpoint[i].desc;
        endpoint_num = usb_endpoint_num(endpoint);

        if (usb_endpoint_dir_in(endpoint) &&
            usb_endpoint_xfer_bulk(endpoint)) {
            if (!usb_dev->bulk_in_pipe) {
                usb_dev->bulk_in_pipe = usb_rcvbulkpipe(usb, endpoint_num);
            }
        }

        if (usb_endpoint_dir_out(endpoint) &&
            usb_endpoint_xfer_bulk(endpoint)) {
            if (!usb_dev->bulk_out_pipe)
            {
                usb_dev->bulk_out_pipe = usb_sndbulkpipe(usb, endpoint_num);
            }
#ifdef CONFIG_USB_MSG_EP
             else if (!usb_dev->msg_out_pipe) {
                usb_dev->msg_out_pipe = usb_sndbulkpipe(usb, endpoint_num);
            }
#endif
        }
    }

    if (usb_dev->bulk_in_pipe == 0) {
        usb_err("No RX (in) Bulk EP found\n");
        ret = -ENODEV;
        goto exit;
    }
    if (usb_dev->bulk_out_pipe == 0) {
        usb_err("No TX (out) Bulk EP found\n");
        ret = -ENODEV;
        goto exit;
    }

#ifdef CONFIG_USB_MSG_EP
	if ( usb_dev->msg_out_pipe != 0 &&
        (usb_dev->chipid == PRODUCT_ID_AIC8801 ||
        usb_dev->chipid == PRODUCT_ID_AIC8800D81||
        usb_dev->chipid == PRODUCT_ID_AIC8800D81X2 ||
        usb_dev->chipid == PRODUCT_ID_AIC8800D89X2)){
		printk("TX Msg Bulk EP found\n");
		usb_dev->use_msg_ep = 1;
	}else{
		usb_dev->use_msg_ep = 0;
	}

#if 0
		if (usb_dev->msg_out_pipe == 0) {
			usb_err("No TX Msg (out) Bulk EP found\n");
			usb_dev->use_msg_ep = 0;
		}else{
			usb_dev->use_msg_ep = 1;
		}
#endif
#endif

    printk("Aic %s speed USB device detected\n", 
            (usb->speed == USB_SPEED_SUPER) ? "super" :
            (usb->speed == USB_SPEED_HIGH)  ? "high"  :
            (usb->speed == USB_SPEED_FULL)  ? "full"  :
            (usb->speed == USB_SPEED_LOW)   ? "low"   : "NG");
    exit:
    return ret;
}



static struct aicwf_bus_ops aicwf_usb_bus_ops = {
    .start = aicwf_usb_bus_start,
    .stop = aicwf_usb_bus_stop,
    .txdata = aicwf_usb_bus_txdata,
    .txmsg = aicwf_usb_bus_txmsg,
};

#if 0
u32 patch_tbl[][2] =
{
#if defined(CONFIG_RFTEST)
    {JUMP_TABLE_OFFSET(28), 0x16b4c5}, // 161998
    {JUMP_TABLE_OFFSET(130), 0x16b379}, // 161B30
    {JUMP_TABLE_OFFSET(126), 0x16b155}, // 161B20
    {JUMP_TABLE_OFFSET(132), 0x16b38d}, // 161b38
    {JUMP_TABLE_OFFSET(34), 0x16b515}, // 1619b0
#elif defined(CONFIG_PLATFORM_UBUNTU)
    {JUMP_TABLE_OFFSET(28), 0x16b5a5}, // 161998
    {JUMP_TABLE_OFFSET(130), 0x16b459}, // 161B30
    {JUMP_TABLE_OFFSET(126), 0x16b235}, // 161B20
    {JUMP_TABLE_OFFSET(132), 0x16b46d}, // 161b38
    {JUMP_TABLE_OFFSET(34), 0x16b5f5}, // 1619b0
#else
    {JUMP_TABLE_OFFSET(28), 0x16b231}, // 161998
    {JUMP_TABLE_OFFSET(130), 0x16b0e5}, // 161B30
    {JUMP_TABLE_OFFSET(126), 0x16aec1}, // 161B20
    {JUMP_TABLE_OFFSET(132), 0x16b0f9}, // 161b38
    {JUMP_TABLE_OFFSET(34), 0x16b281}, // 1619b0
#endif
};
#endif

#if 0
u32 patch_tbl_rf[][2] =
{
    {JUMP_TABLE_OFFSET(28), 0x16b4c5}, // 161998
    {JUMP_TABLE_OFFSET(130), 0x16b379}, // 161B30
    {JUMP_TABLE_OFFSET(126), 0x16b155}, // 161B20
    {JUMP_TABLE_OFFSET(132), 0x16b38d}, // 161b38
    {JUMP_TABLE_OFFSET(34), 0x16b515}, // 1619b0
};
#endif
#if 0
u32 patch_tbl[18][2] =
{
    {0x0044, 0x00000002}, //hosttype
    {0x0048, 0x00000060},
#ifdef CONFIG_USB_BT
    {0x004c, 0x00000040},
#else
    {0x004c, 0x00000046},
#endif
    {0x0050, 0x00000000}, //ipc base
    {0x0054, 0x001a0000}, //buf base
    {0x0058, 0x001a0140}, //desc base
    {0x005c, 0x00000ee0}, //desc size
    {0x0060, 0x001a1020}, //pkt base
#ifdef CONFIG_USB_BT
    {0x0064, 0x0001EFE0}, //pkt size
#else
    {0x0064, 0x000207e0}, //pkt size
#endif
    {0x0068, 0x00000008},
    {0x006c, 0x00000040},
    {0x0070, 0x00000040},
    {0x0074, 0x00000020},
    {0x0078, 0x00000000},
    {0x007c, 0x00000040},
    {0x0080, 0x00190000},
    {0x0084, 0x0000fc00},//63kB
    {0x0088, 0x0019fc00}
};
#endif

u32 adaptivity_patch_tbl[][2] = {
	{0x0004, 0x0000320A}, //linkloss_thd
    {0x0094, 0x00000000}, //ac_param_conf
	{0x00F8, 0x00010138}, //tx_adaptivity_en
};

u32 patch_tbl[][2] ={
{0x0044, 0x00000002}, //hosttype
{0x0048, 0x00000060},
#if 1//def CONFIG_USB_BT
#ifdef CONFIG_USB_MSG_EP
{0x004c, 0x00040050},
#else
{0x004c, 0x00000052},
#endif
#else
{0x004c, 0x00000046},
#endif
{0x0050, 0x00000000}, //ipc base
{0x0054, 0x00190000}, //buf base
{0x0058, 0x00190140}, //desc base
{0x005c, 0x00000ee0}, //desc size
{0x0060, 0x00191020}, //pkt base
#if 1//def CONFIG_USB_BT
{0x0064, 0x0002EFE0}, //pkt size
#else
{0x0064, 0x000207e0}, //pkt size
#endif
{0x0068, 0x00000008},    //tx BK A-MPDU 8
{0x006c, 0x00000040},    //tx BE A-MPDU 40
{0x0070, 0x00000040},    //tx VI A-MPDU 40
{0x0074, 0x00000020},    //tx VO A-MPDU 20
{0x0078, 0x00000000},    //bcn queue
{0x007c, 0x00000020},    //rx A-MPDU 20
{0x0080, 0x001d0000},
{0x0084, 0x0000fc00},//63kB
{0x0088, 0x001dfc00},
{0x00A8, 0x8D080103},//dm 8D08
{0x00D0, 0x00010103},//aon sram
#ifdef CONFIG_USB_MSG_EP
{0x00D4, 0x0404087C},
#else
{0x00D4, 0x0000087C},
#endif
{0x00D8, 0x001C0000},//bt base
{0x00DC, 0x00008000},//bt size
{0x00E0, 0x04020A08},
{0x00E4, 0x00000001},
#ifdef CONFIG_USB_MSG_EP
{0x00FC, 0x00000302},//rx msg fc pkt cnt
#endif
{0x0100, 0x0000000F}, //usb_reboot_additional_delay
#if !defined(CONFIG_LINK_DET_5G)
{0x0104, 0x00000000}, //link_det_5g
#endif
#ifdef CONFIG_USB_SUSPEND_REBOOT_TIME
{0x0110, 0x03e80001}//reboot time when usb suspend,0001 enables reboot on suspend, default 0x3e8 = 1000ms reboot
#else
#ifdef CONFIG_SUPPORT_USB_SUSP
//USB SUSP keep working 0x0100:enable 0x0000:disable
{0x0110, 0x00000100}
#endif
#endif
};


#if 0
u32 patch_tbl[][2] =
{
#ifdef CONFIG_PLATFORM_UBUNTU
    {JUMP_TABLE_OFFSET(28), 0x16b5a5}, // 161998
    {JUMP_TABLE_OFFSET(130), 0x16b459}, // 161B30
    {JUMP_TABLE_OFFSET(126), 0x16b235}, // 161B20
    {JUMP_TABLE_OFFSET(132), 0x16b46d}, // 161b38
    {JUMP_TABLE_OFFSET(34), 0x16b5f5}, // 1619b0
#else
    {JUMP_TABLE_OFFSET(28), 0x16b231}, // 161998
    {JUMP_TABLE_OFFSET(130), 0x16b0e5}, // 161B30
    {JUMP_TABLE_OFFSET(126), 0x16aec1}, // 161B20
    {JUMP_TABLE_OFFSET(132), 0x16b0f9}, // 161b38
    {JUMP_TABLE_OFFSET(34), 0x16b281}, // 1619b0
#endif
};
#endif

u32 syscfg_tbl_pmic_u02[][2] = {
    {0x40040000, 0x00001AC8}, // 1) fix panic
    {0x40040084, 0x00011580},
    {0x40040080, 0x00000001},
    {0x40100058, 0x00000000},
};

u32 syscfg_tbl_u04[][2] = {
    {0x40040000, 0x0000042C}, // protect usb replenish rxq / flush rxq, skip flush rxq before start_app
    {0x40040004, 0x0000DD44},
    {0x40040008, 0x00000448},
    {0x4004000C, 0x0000044C},
    {0x0019B800, 0xB9F0F19B},
    {0x0019B804, 0x0019B81D},
    {0x0019B808, 0xBF00FA79},
    {0x0019B80C, 0xF007BF00},
    {0x0019B810, 0x4605B672}, // code
    {0x0019B814, 0x21E0F04F},
    {0x0019B818, 0xBE0BF664},
    {0x0019B81C, 0xF665B510},
    {0x0019B820, 0x4804FC9D},
    {0x0019B824, 0xFA9EF66C},
    {0x0019B828, 0xFCA8F665},
    {0x0019B82C, 0x4010E8BD},
    {0x0019B830, 0xBAC6F66C},
    {0x0019B834, 0x0019A0C4},
    {0x40040084, 0x0019B800}, // out base
    {0x40040080, 0x0000000F},
    {0x40100058, 0x00000000},
};

u32 syscfg_tbl[][2] = {
    {0x40500014, 0x00000101}, // 1)
    {0x40500018, 0x0000010d}, // 2)//bt only:10d ,bt combo and bt only sw:109
    {0x40500004, 0x00000010}, // 3) the order should not be changed
    #if 1//CONFIG_PMIC_SETTING
    {0x50000000, 0x03220204}, // 2) pmic interface init
    {0x50019150, 0x00000002},
    {0x50017008, 0x00000000}, // 4) stop wdg
    #endif /* CONFIG_PMIC_SETTING */
};

u32 sys_reboot_tbl[][2] = {
    {0x50017000, 0x0001ffff},
    {0x50017008, 0x00000002},
};

#if 0
u32 bt_config_tbl[][2] =
{
    {0x0016f000, 0xe0250793},
    {0x40080000, 0x0008bd64},
    #if 0
    {0x0016f004, 0xe0052b00},
    {0x40080004, 0x000b5570},
    {0x0016f008, 0xe7b12b00},
    {0x40080008, 0x000b5748},
    {0x0016f00c, 0x001ad00e},
    {0x4008000c, 0x000ac8f8},
    #endif
    {0x40080084, 0x0016f000}, // out
    {0x40080080, 0x00000001}, // en
    {0x40100058, 0x00000000}, // bypass
};
#endif

u32 rf_tbl_masked[][3] = {
	{0x40344058, 0x00800000, 0x00000000},// pll trx
};

static int system_config_8800(struct aic_usb_dev *usb_dev){
    int syscfg_num;
    int ret, cnt;
    const u32 mem_addr = 0x40500000;
    struct dbg_mem_read_cfm rd_mem_addr_cfm;
    ret = rwnx_send_dbg_mem_read_req(usb_dev, mem_addr, &rd_mem_addr_cfm);
    if (ret) {
        printk("%x rd fail: %d\n", mem_addr, ret);
        return ret;
    }
    chip_id =(u8)(rd_mem_addr_cfm.memdata >> 16);
    //printk("%x=%x\n", rd_mem_addr_cfm.memaddr, rd_mem_addr_cfm.memdata);
    ret = rwnx_send_dbg_mem_read_req(usb_dev, 0x00000004, &rd_mem_addr_cfm);
    if (ret) {
        printk("[0x00000004] rd fail: %d\n", ret);
        return ret;
    }
    chip_sub_id = (u8)(rd_mem_addr_cfm.memdata >> 4);
    //printk("%x=%x\n", rd_mem_addr_cfm.memaddr, rd_mem_addr_cfm.memdata);
    printk("chip_id=%x, chip_sub_id=%x\n", chip_id, chip_sub_id);
    if (chip_id == CHIP_REV_U02) {
        syscfg_num = sizeof(syscfg_tbl_pmic_u02) / sizeof(u32) / 2;
        for (cnt = 0; cnt < syscfg_num; cnt++) {
            ret = rwnx_send_dbg_mem_write_req(usb_dev, syscfg_tbl_pmic_u02[cnt][0], syscfg_tbl_pmic_u02[cnt][1]);
            if (ret) {
                printk("%x write fail: %d\n", syscfg_tbl_pmic_u02[cnt][0], ret);
                return ret;
            }
        }
    }
    if ((chip_id == CHIP_REV_U03) && (chip_sub_id == CHIP_SUB_REV_U04)) {
        syscfg_num = sizeof(syscfg_tbl_u04) / sizeof(u32) / 2;
        printk("cfg u04\n");
        for (cnt = 0; cnt < syscfg_num; cnt++) {
            ret = rwnx_send_dbg_mem_write_req(usb_dev, syscfg_tbl_u04[cnt][0], syscfg_tbl_u04[cnt][1]);
            if (ret) {
                printk("%x write fail: %d\n", syscfg_tbl_u04[cnt][0], ret);
                return ret;
            }
        }
    }
    syscfg_num = sizeof(syscfg_tbl) / sizeof(u32) / 2;
    for (cnt = 0; cnt < syscfg_num; cnt++) {
        ret = rwnx_send_dbg_mem_write_req(usb_dev, syscfg_tbl[cnt][0], syscfg_tbl[cnt][1]);
        if (ret) {
            printk("%x write fail: %d\n", syscfg_tbl[cnt][0], ret);
            return ret;
        }
    }
    return 0;

}

static int system_config(struct aic_usb_dev *usb_dev)
{
    if(usb_dev->chipid == PRODUCT_ID_AIC8800){
        return system_config_8800(usb_dev);
    }else if(usb_dev->chipid == PRODUCT_ID_AIC8800D80){
        return system_config_8800d80(usb_dev);
    }else if(usb_dev->chipid == PRODUCT_ID_AIC8800D80X2){
        return system_config_8800d80x2(usb_dev);
    }else{
        return -1;
    }
}


static int system_reboot(struct aic_usb_dev *usb_dev)
{
    int syscfg_num;
    int ret, cnt;

    syscfg_num = sizeof(sys_reboot_tbl) / sizeof(u32) / 2;
    for (cnt = 0; cnt < syscfg_num; cnt++) {
        ret = rwnx_send_dbg_mem_write_req(usb_dev, sys_reboot_tbl[cnt][0], sys_reboot_tbl[cnt][1]);
        if (ret) {
            printk("%x write fail: %d\n", sys_reboot_tbl[cnt][0], ret);
            return ret;
        }
    }
    return 0;
}

static int rf_config(struct aic_usb_dev *usb_dev)
{
    int ret;
    ret = rwnx_send_dbg_mem_mask_write_req(usb_dev,
                rf_tbl_masked[0][0], rf_tbl_masked[0][1], rf_tbl_masked[0][2]);
    if (ret) {
        printk("rf config %x write fail: %d\n", rf_tbl_masked[0][0], ret);
    }

	return ret;
}

static int patch_config(struct aic_usb_dev *usb_dev)
{

    int ret = 0;
    int    cnt = 0;
    int patch_num = 0;
    uint32_t start_addr = 0x1e6000;
    u32 patch_addr = start_addr;
    u32 config_base;
    struct dbg_mem_read_cfm rd_patch_addr_cfm;
    const u32 rd_patch_addr = RAM_FW_ADDR + 0x0180;
	int tmp_cnt = 0;
	int adap_patch_num = 0;

    printk("%s enter \r\n", __func__);

    //if (testmode) {
        patch_num = sizeof(patch_tbl)/4;

        printk("Read FW mem: %08x\n", rd_patch_addr);
        if ((ret = rwnx_send_dbg_mem_read_req(usb_dev, rd_patch_addr, &rd_patch_addr_cfm))) {
            printk("patch rd fail\n");
        }

        printk("%x=%x\n", rd_patch_addr_cfm.memaddr, rd_patch_addr_cfm.memdata);
        config_base = rd_patch_addr_cfm.memdata;

		//if (testmode == FW_NORMAL_MODE) {
	        if((ret = rwnx_send_dbg_mem_write_req(usb_dev, 0x1e5318, patch_addr))) {
	            printk("%x write fail\n", 0x1e5318);
	        }
            
			if(adap_test){
				printk("%s for adaptivity test \r\n", __func__);
				adap_patch_num = sizeof(adaptivity_patch_tbl)/4;
		        if((ret = rwnx_send_dbg_mem_write_req(usb_dev, 0x1e531c, patch_num + adap_patch_num))) {
		            printk("%x write fail\n", 0x1e531c);
		        }
			}else{
		        if((ret = rwnx_send_dbg_mem_write_req(usb_dev, 0x1e531c, patch_num))) {
		            printk("%x write fail\n", 0x1e531c);
		        }
			}
		//}else if(testmode == FW_TEST_MODE){//for old rf fw
	    //    if((ret = rwnx_send_dbg_mem_write_req(usb_dev, 0x1e4d78, patch_addr))) {
	    //        printk("%x write fail\n", 0x1e4d80);
	    //    }
	    //    if((ret = rwnx_send_dbg_mem_write_req(usb_dev, 0x1e4d7C, patch_num))) {
	    //        printk("%x write fail\n", 0x1e4d84);
	    //    }
		//}

        for(cnt = 0; cnt < patch_num/2; cnt+=1)
        {
            if((ret = rwnx_send_dbg_mem_write_req(usb_dev, start_addr+8*cnt, patch_tbl[cnt][0]+config_base))) {
                printk("%x write fail\n", start_addr+8*cnt);
            }

            if((ret = rwnx_send_dbg_mem_write_req(usb_dev, start_addr+8*cnt+4, patch_tbl[cnt][1]))) {
                printk("%x write fail\n", start_addr+8*cnt+4);
            }

        }

		tmp_cnt = cnt;

		if(adap_test){
			for(cnt = 0; cnt < adap_patch_num/2; cnt+=1)
			{
				if((ret = rwnx_send_dbg_mem_write_req(usb_dev, start_addr+8*(cnt+tmp_cnt), adaptivity_patch_tbl[cnt][0]+config_base))) {
					printk("%x write fail\n", start_addr+8*cnt);
				}

				if((ret = rwnx_send_dbg_mem_write_req(usb_dev, start_addr+8*(cnt+tmp_cnt)+4, adaptivity_patch_tbl[cnt][1]))) {
					printk("%x write fail\n", start_addr+8*cnt+4);
				}
			}
		}

        return ret;
#if 0
    } else {
        patch_num = sizeof(patch_tbl) / sizeof(u32) / 2;

        for(cnt = 0; cnt < patch_num; cnt++) {
            ret = rwnx_send_dbg_mem_write_req(usb_dev, patch_tbl[cnt][0], patch_tbl[cnt][1]);
            if(ret) {
            printk("%x write fail: %d\n", patch_tbl[cnt][0], ret);
            break;
            }
        }
        return ret;
    }
#endif
}

#if 0
static int bt_config(struct aic_usb_dev *usb_dev)
{
    int trap_num = sizeof(bt_config_tbl) / sizeof(u32) / 2;
    int ret, cnt;

    printk("%s enter \r\n", __func__);
    for(cnt = 0; cnt < trap_num; cnt++) {
        ret = rwnx_send_dbg_mem_write_req(usb_dev, bt_config_tbl[cnt][0], bt_config_tbl[cnt][1]);
        if(ret) {
            printk("%x write fail: %d\n", bt_config_tbl[cnt][0], ret);
            break;
        }
    }
    return ret;
}
#endif

static int get_paring_ids(char* c_paringids, int* i_paringids){
	int i = 0;
	int len = strlen(c_paringids);
	int paring_id_num = 0;
	char temp_paring_id[5];

//get paring_id_num
	for(i = 4; i < len; i += 5){
		if(c_paringids[i] == ','){
			paring_id_num++;
		}else if(c_paringids[i] == 0x00){
			break;
		}else{
			paring_id_num = 0;
			break;
		}
	}

	if(paring_id_num == 0 && len == 0){
		printk("%s paring_id_num:%d \r\n", __func__, paring_id_num);
		return 0;
	}else{
		paring_id_num++;
	}

//parsing paring_id
	for(i = 0; i < paring_id_num; i++){
		memset(temp_paring_id, 0, 5);
		temp_paring_id[0] = c_paringids[(i * 5)];
		temp_paring_id[1] = c_paringids[(i * 5) + 1];
		temp_paring_id[2] = c_paringids[(i * 5) + 2];
		temp_paring_id[3] = c_paringids[(i * 5) + 3];
		i_paringids[i] = rwnx_atoli(temp_paring_id);
	}

	return paring_id_num;
}

static int aicloadfw_chipmatch(struct aic_usb_dev *usb_dev, u16 vid, u16 pid){

    if(pid == USB_DEVICE_ID_AIC){
        usb_dev->chipid = PRODUCT_ID_AIC8800;
	AICWFDBG(LOGINFO, "%s USE AIC8800\r\n", __func__);
	return 0;
    }else if(pid == USB_DEVICE_ID_AIC_8801){
	usb_dev->chipid = PRODUCT_ID_AIC8801;
	AICWFDBG(LOGINFO, "%s USE AIC8801\r\n", __func__);
	return 0;
    }else if(pid == USB_DEVICE_ID_AIC_8800D80){
	usb_dev->chipid = PRODUCT_ID_AIC8800D80;
	AICWFDBG(LOGINFO, "%s USE AIC8800D80\r\n", __func__);
	return 0;
    }else if(pid == USB_DEVICE_ID_AIC_8800D81){
        usb_dev->chipid = PRODUCT_ID_AIC8800D81;
	AICWFDBG(LOGINFO, "%s USE AIC8800D81\r\n", __func__);
        return 0;
    }else if(pid == USB_DEVICE_ID_AIC_8800D40){
        usb_dev->chipid = PRODUCT_ID_AIC8800D80;
        AICWFDBG(LOGINFO, "%s USE AIC8800D40\r\n", __func__);
        return 0;
    }else if(pid == USB_DEVICE_ID_AIC_8800D41){
	usb_dev->chipid = PRODUCT_ID_AIC8800D81;
	AICWFDBG(LOGINFO, "%s USE AIC8800D41\r\n", __func__);
	return 0;
    }else if(pid == USB_DEVICE_ID_AIC_8800D80X2 && vid == USB_VENDOR_ID_AIC_V2){
		usb_dev->chipid = PRODUCT_ID_AIC8800D80X2;
		AICWFDBG(LOGINFO, "%s USE AIC8800D80X2\r\n", __func__);
		return 0;
    }else if(pid == USB_DEVICE_ID_AIC_8800D81X2 && vid == USB_VENDOR_ID_AIC_V2){
		usb_dev->chipid = PRODUCT_ID_AIC8800D81X2;
		AICWFDBG(LOGINFO, "%s USE AIC8800D81X2\r\n", __func__);
		return 0;
    }else if(pid == USB_DEVICE_ID_AIC_8800D89X2 && vid == USB_VENDOR_ID_AIC_V2){
		usb_dev->chipid = PRODUCT_ID_AIC8800D89X2;
		AICWFDBG(LOGINFO, "%s USE AIC8800D89X2\r\n", __func__);
		return 0;
    }else if(pid == USB_DEVICE_ID_AIC_8800D40X2 && vid == USB_VENDOR_ID_AIC_V2){
                usb_dev->chipid = PRODUCT_ID_AIC8800D80X2;
                AICWFDBG(LOGINFO, "%s USE AIC8800D40X2\r\n", __func__);
                return 0;
    }else{
        return -1;
    }
}

int aicfw_download_fw_8800(struct aic_usb_dev *usb_dev){
    //uint32_t paring_id = 0;
	uint32_t* paring_ids;
	int paring_id_num = 0;
	int i = 0;
    const u32 fw_addr = RAM_FW_ADDR;
    
#ifdef CONFIG_M2D_OTA_AUTO_SUPPORT
        if(testmode == FW_M2D_OTA_MODE){
            rwnx_plat_m2d_flash_ota_android(usb_dev,FW_M2D_OTA_NAME);
        }else if(testmode == FW_NORMAL_MODE) {
            rwnx_plat_m2d_flash_ota_check(usb_dev,FW_M2D_OTA_NAME);
        }
#endif
        if(testmode == FW_TEST_MODE){
            if (rwnx_plat_bin_fw_upload_android(usb_dev, RAM_FW_ADDR, FW_RF_BASE_NAME)) {
                return -1;
            }
    
            if (chip_id == CHIP_REV_U03) {
                if(rwnx_plat_bin_fw_upload_android(usb_dev, FW_RAM_ADID_BASE_ADDR, FW_ADID_BASE_NAME_U03)) {
                    return -1;;
                }
    
                if(rwnx_plat_bin_fw_upload_android(usb_dev, FW_RAM_PATCH_BASE_ADDR_U03, FW_PATCH_BASE_NAME_U03)) {
                    return -1;;
                }
            } else {
                if(rwnx_plat_bin_fw_upload_android(usb_dev, FW_RAM_ADID_BASE_ADDR, FW_ADID_BASE_NAME)) {
                    return -1;;
                }
    
                if(rwnx_plat_bin_fw_upload_android(usb_dev, FW_RAM_PATCH_BASE_ADDR, FW_PATCH_BASE_NAME)) {
                    return -1;;
                }
            }
    
#if 0
            if(rwnx_plat_bin_fw_upload_android(usb_dev, FW_RAM_ADID_BASE_ADDR, FW_RF_ADID_BASE_NAME)) {
                goto out_free_bus;
            }
    
            if(rwnx_plat_bin_fw_upload_android(usb_dev, FW_RAM_PATCH_BASE_ADDR, FW_RF_PATCH_BASE_NAME)) {
                goto out_free_bus;
            }
#endif
        } else if(testmode == FW_BLE_SCAN_WAKEUP_MODE){
#if 0
            paring_id = rwnx_atoli(paringid);
            rwnx_plat_bin_fw_upload_android(usb_dev, RAM_FW_BLE_SCAN_WAKEUP_ADDR, FW_BLE_SCAN_WAKEUP_NAME);
            rwnx_send_dbg_mem_write_req(usb_dev, 0x15FF00, 0x53454C42);//magic_num
            rwnx_send_dbg_mem_write_req(usb_dev, 0x15FF04, ble_scan_wakeup_reboot_time);//reboot time
            rwnx_send_dbg_mem_write_req(usb_dev, 0x15FF08, paring_id);
            rwnx_send_dbg_mem_write_req(usb_dev, 0x15FF0c, paring_id);
            rwnx_send_dbg_start_app_req(usb_dev, RAM_FW_BLE_SCAN_WAKEUP_ADDR, HOST_START_APP_AUTO);
#endif
#if 1
            paring_ids = (uint32_t*)kmalloc(sizeof(uint32_t) * 8, GFP_KERNEL);
            rwnx_plat_bin_fw_upload_android(usb_dev, RAM_FW_BLE_SCAN_WAKEUP_ADDR, FW_BLE_SCAN_WAKEUP_NAME);
            rwnx_send_dbg_mem_write_req(usb_dev, 0x15FF00, 0x53454C42);//magic_num
            rwnx_send_dbg_mem_write_req(usb_dev, 0x15FF04, ble_scan_wakeup_reboot_time);//reboot time
            paring_id_num = get_paring_ids(paringid, paring_ids);
            for(i = 0; i < paring_id_num; i++){
                printk("paring_ids[%d]:0x%X \r\n", i, paring_ids[i]);
                rwnx_send_dbg_mem_write_req(usb_dev, 0x15FF08 + (4 * i), paring_ids[i]);
            }
            rwnx_send_dbg_start_app_req(usb_dev, RAM_FW_BLE_SCAN_WAKEUP_ADDR, HOST_START_APP_AUTO);
            kfree(paring_ids);
#endif
            return -1;

        } else if(testmode == FW_BLE_SCAN_AD_FILTER_MODE){
/*
            data and ad_data_filter_mask instructions for use
            ex.
            data[18] = {0x46,0x00,0x00,0xff,0xff,0xff,0xff,0xff,0xff,0x30,0xff,0xff,0xff,0x43,0x52,0x45,0x4c,0x42};
            mask = 1100 0000 0111 1111 1100 0000 0000 0000 = 0xc07fc000

            data  = 0x46,0x00,0x00,0xff,0xff,0xff,0xff,0xff,0xff,0x30,0xff,0xff,0xff,0x43,0x52,0x45,0x4c,0x42
            mask =  1      1       0     0     0    0     0     0    0     1      1     1    1    1      1      1      1      1      0     0...... fill 0

            data & mask = "0x46 0x00" 0x00 0x00 0x00 0x00 0x00 0x00 0x00 "0x30 0xff 0xff 0x43 0x52 0x45 0x4c 0x42"
            using data & mask value condition to wakeup host_wake_bt gpio
*/
            struct ble_wakeup_param_t* wakeup_param = (struct ble_wakeup_param_t*)kmalloc(sizeof(struct ble_wakeup_param_t), GFP_KERNEL);
            uint32_t *write_blocks = (uint32_t *)wakeup_param;

            printk("%s ble scan wakeup \r\n", __func__);

            memset(wakeup_param, 0, sizeof(struct ble_wakeup_param_t));
            rwnx_plat_bin_fw_upload_android(usb_dev, RAM_FW_BLE_SCAN_WAKEUP_ADDR, FW_BLE_SCAN_AD_FILTER_NAME);
            wakeup_param->magic_num = 0x53454C42;//magic_num
            wakeup_param->delay_scan_to = 1000;//delay start scan time(ms)
            wakeup_param->reboot_to = ble_scan_wakeup_reboot_time;//reboot time
            /******************************************************************/
            ///gpio_trigger_idx : 0    if wakeup_param->gpio_dft_lvl[0]=0xfe,this idx will be invalid.
            wakeup_param->gpio_num[0] = gpio_num;////default select gpiob2 for fw_wakeup_host
            wakeup_param->gpio_dft_lvl[0] = gpio_dft_lvl;////0:defalut pull down,  1:default pull up
            ///gpio_trigger_idx : 1    if wakeup_param->gpio_dft_lvl[1]=0xfe,this idx will be invalid.
            wakeup_param->gpio_num[1] = 3;////default select gpiob2 for fw_wakeup_host
            wakeup_param->gpio_dft_lvl[1] = 1;////0:defalut pull down,  1:default pull up
            /********************************************************************/
			/********************************************************************/
			//MAX_AD_FILTER_NUM=5 :num 0
			{
				const uint8_t data[11] = {0x59,0x4B,0x32,0x42,0x41,0x5F,0x54,0x45,0x53,0x54,0x33};
				wakeup_param->ad_filter[0].ad_len = 12;
				wakeup_param->ad_filter[0].ad_type = 0x09;
				memcpy(wakeup_param->ad_filter[0].ad_data, data,wakeup_param->ad_filter[0].ad_len-1);// 1111 1111 1110 0000 0000 0000 0000 0000 //0xffe00000
				wakeup_param->ad_filter[0].ad_data_mask = 0xffe00000;
				wakeup_param->ad_filter[0].ad_role = ROLE_COMBO|(COMBO_0<<4);
				wakeup_param->ad_filter[0].gpio_trigger_idx = TG_IDX_0;//0: match for wakeup_param->gpio_num[0] 	  1: match for wakeup_param->gpio_num[1]
				/********************************************************************/
				/*enable white list addr for paired remote ble addr. if all 0: all addr will use ad filter
														wl_addr have value xx: only remote addr in white_list_addr will use ad filter
				********************************************************************/
				wakeup_param->ad_filter[0].wl_addr.addr[0] = 0;
				wakeup_param->ad_filter[0].wl_addr.addr[1] = 0;
				wakeup_param->ad_filter[0].wl_addr.addr[2] = 0;
				wakeup_param->ad_filter[0].wl_addr.addr[3] = 0;
				wakeup_param->ad_filter[0].wl_addr.addr[4] = 0;
				wakeup_param->ad_filter[0].wl_addr.addr[5] = 0;
			}
			/********************************************************************/
			//MAX_AD_FILTER_NUM=5 :num 1
			{
				const uint8_t data[2] = {0x12,0x18};
				wakeup_param->ad_filter[1].ad_len = 3;
				wakeup_param->ad_filter[1].ad_type = 0x3;
				memcpy(wakeup_param->ad_filter[1].ad_data, data,wakeup_param->ad_filter[1].ad_len-1);// 1100 0000 0000 0000 0000 0000 0000 0000 //0xc0000000
				wakeup_param->ad_filter[1].ad_data_mask = 0xc0000000;
				wakeup_param->ad_filter[1].ad_role = ROLE_COMBO|(COMBO_0<<4);
				wakeup_param->ad_filter[1].gpio_trigger_idx = TG_IDX_0;//0: match for wakeup_param->gpio_num[0] 	  1: match for wakeup_param->gpio_num[1]
				/********************************************************************/
				/*enable white list addr for paired remote ble addr. if all 0: all addr will use ad filter
														wl_addr have value xx: only remote addr in white_list_addr will use ad filter
				********************************************************************/
				wakeup_param->ad_filter[1].wl_addr.addr[0] = 0;
				wakeup_param->ad_filter[1].wl_addr.addr[1] = 0;
				wakeup_param->ad_filter[1].wl_addr.addr[2] = 0;
				wakeup_param->ad_filter[1].wl_addr.addr[3] = 0;
				wakeup_param->ad_filter[1].wl_addr.addr[4] = 0;
				wakeup_param->ad_filter[1].wl_addr.addr[5] = 0;
			}
			/********************************************************************/
			//MAX_AD_FILTER_NUM=5 :num 2
			{
				//const uint8_t data[11] = {0x59,0x4B,0x32,0x42,0x41,0x5F,0x54,0x45,0x53,0x54,0x33};
				wakeup_param->ad_filter[2].ad_len = 0;
				wakeup_param->ad_filter[2].ad_type = 0;
				//memcpy(wakeup_param->ad_filter[2].ad_data, data,wakeup_param->ad_filter[2].ad_len-1);// 1100 0000 0111 1111 1100 0000 0000 0000 //0xc07fc000
				wakeup_param->ad_filter[2].ad_data_mask = 0;
				wakeup_param->ad_filter[2].ad_role = ROLE_ONLY;
				wakeup_param->ad_filter[2].gpio_trigger_idx = TG_IDX_0;//0: match for wakeup_param->gpio_num[0] 	  1: match for wakeup_param->gpio_num[1]
				/********************************************************************/
				/*enable white list addr for paired remote ble addr. if all 0: all addr will use ad filter
														wl_addr have value xx: only remote addr in white_list_addr will use ad filter
				********************************************************************/
				wakeup_param->ad_filter[2].wl_addr.addr[0] = 0;
				wakeup_param->ad_filter[2].wl_addr.addr[1] = 0;
				wakeup_param->ad_filter[2].wl_addr.addr[2] = 0;
				wakeup_param->ad_filter[2].wl_addr.addr[3] = 0;
				wakeup_param->ad_filter[2].wl_addr.addr[4] = 0;
				wakeup_param->ad_filter[2].wl_addr.addr[5] = 0;
			}
			/********************************************************************/
			//MAX_AD_FILTER_NUM=5 :num 3
			{
				//const uint8_t data[11] = {0x59,0x4B,0x32,0x42,0x41,0x5F,0x54,0x45,0x53,0x54,0x33};
				wakeup_param->ad_filter[3].ad_len = 0;
				wakeup_param->ad_filter[3].ad_type = 0;
				//memcpy(wakeup_param->ad_filter[2].ad_data, data,wakeup_param->ad_filter[2].ad_len-1);// 1100 0000 0111 1111 1100 0000 0000 0000 //0xc07fc000
				wakeup_param->ad_filter[3].ad_data_mask = 0;
				wakeup_param->ad_filter[3].ad_role = ROLE_COMBO|(COMBO_1<<4);
				wakeup_param->ad_filter[3].gpio_trigger_idx = TG_IDX_0;//0: match for wakeup_param->gpio_num[0] 	  1: match for wakeup_param->gpio_num[1]
				/********************************************************************/
				/*enable white list addr for paired remote ble addr. if all 0: all addr will use ad filter
														wl_addr have value xx: only remote addr in white_list_addr will use ad filter
				********************************************************************/
				wakeup_param->ad_filter[3].wl_addr.addr[0] = 0;
				wakeup_param->ad_filter[3].wl_addr.addr[1] = 0;
				wakeup_param->ad_filter[3].wl_addr.addr[2] = 0;
				wakeup_param->ad_filter[3].wl_addr.addr[3] = 0;
				wakeup_param->ad_filter[3].wl_addr.addr[4] = 0;
				wakeup_param->ad_filter[3].wl_addr.addr[5] = 0;
			}
			/********************************************************************/
			//MAX_AD_FILTER_NUM=5 :num 4
			{
				//const uint8_t data[11] = {0x59,0x4B,0x32,0x42,0x41,0x5F,0x54,0x45,0x53,0x54,0x33};
				wakeup_param->ad_filter[4].ad_len = 0;
				wakeup_param->ad_filter[4].ad_type = 0x09;
				//memcpy(wakeup_param->ad_filter[4].ad_data, data,wakeup_param->ad_filter[4].ad_len-1);// 1111 1111 1110 0000 0000 0000 0000 0000 //0xffe00000
				wakeup_param->ad_filter[4].ad_data_mask = 0xffe00000;
				wakeup_param->ad_filter[4].ad_role = ROLE_COMBO|(COMBO_1<<4);
				wakeup_param->ad_filter[4].gpio_trigger_idx = TG_IDX_0|TG_IDX_1;//0: match for wakeup_param->gpio_num[0]	   1: match for wakeup_param->gpio_num[1]
				/********************************************************************/
				/*enable white list addr for paired remote ble addr. if all 0: all addr will use ad filter
														wl_addr have value xx: only remote addr in white_list_addr will use ad filter
				********************************************************************/
				wakeup_param->ad_filter[4].wl_addr.addr[0] = 0;
				wakeup_param->ad_filter[4].wl_addr.addr[1] = 0;
				wakeup_param->ad_filter[4].wl_addr.addr[2] = 0;
				wakeup_param->ad_filter[4].wl_addr.addr[3] = 0;
				wakeup_param->ad_filter[4].wl_addr.addr[4] = 0;
				wakeup_param->ad_filter[4].wl_addr.addr[5] = 0;
			}

            for(i = 0; i < (sizeof(struct ble_wakeup_param_t)/4 +1); i++){
                printk("write_blocks[%d]:0x%08X \r\n", i, write_blocks[i]);
                rwnx_send_dbg_mem_write_req(usb_dev, 0x15FE00 + (4 * i), write_blocks[i]);
            }
            rwnx_send_dbg_start_app_req(usb_dev, RAM_FW_BLE_SCAN_WAKEUP_ADDR, HOST_START_APP_AUTO);
            kfree(wakeup_param);

            return -1;
        }else {
            if (rwnx_plat_bin_fw_upload_android(usb_dev, RAM_FW_ADDR, FW_BASE_NAME)) {
                return -1;;
            }
            if (chip_id == CHIP_REV_U03) {
                if(rwnx_plat_bin_fw_upload_android(usb_dev, FW_RAM_ADID_BASE_ADDR, FW_ADID_BASE_NAME_U03)) {
                    return -1;;
                }
    
                if(rwnx_plat_bin_fw_upload_android(usb_dev, FW_RAM_PATCH_BASE_ADDR_U03, FW_PATCH_BASE_NAME_U03)) {
                    return -1;;
                }
            } else {
                if(rwnx_plat_bin_fw_upload_android(usb_dev, FW_RAM_ADID_BASE_ADDR, FW_ADID_BASE_NAME)) {
                    return -1;;
                }
    
                if(rwnx_plat_bin_fw_upload_android(usb_dev, FW_RAM_PATCH_BASE_ADDR, FW_PATCH_BASE_NAME)) {
                    return -1;;
                }
            }
        }
        if (chip_id == CHIP_REV_U03) {
            if (rwnx_plat_bin_fw_patch_table_upload_android(usb_dev, FW_PATCH_TABLE_NAME_U03)) {
                return -1;;
            }
        } else {
            if (rwnx_plat_bin_fw_patch_table_upload_android(usb_dev, FW_PATCH_TABLE_NAME)) {
                return -1;;
            }
        }
    
#if 0
        if(testmode == FW_TEST_MODE){
            if(rwnx_plat_bin_fw_upload_android(usb_dev, FW_PATCH_TEST_BASE_ADDR, FW_PATCH_TEST_BASE_NAME)) {
                goto out_free_bus;
            }
        }
#endif
    
        if (rwnx_plat_userconfig_upload_android(usb_dev, FW_USERCONFIG_NAME)){
            return -1;
        }
    
        if (patch_config(usb_dev)) {
            return -1;;
        }
    
        if (rf_config(usb_dev)){
            return -1;;
        }
        if (rwnx_send_dbg_start_app_req(usb_dev, fw_addr, HOST_START_APP_AUTO)) {
            return -1;
        }
        
    return 0;
}


int aicfw_download_fw(struct aic_usb_dev *usb_dev)
{
    if(usb_dev->chipid == PRODUCT_ID_AIC8800){
        return aicfw_download_fw_8800(usb_dev);
    }else if(usb_dev->chipid == PRODUCT_ID_AIC8800D80){
        return aicfw_download_fw_8800d80(usb_dev);
    }else if(usb_dev->chipid == PRODUCT_ID_AIC8800D80X2){
        return aicfw_download_fw_8800d80x2(usb_dev);
    }else{
        return -1;
    }
}


static int aicwf_usb_probe(struct usb_interface *intf, const struct usb_device_id *id)
{
    int ret = 0;
    struct usb_device *usb = interface_to_usbdev(intf);
    struct aicwf_bus *bus_if ;
    struct device *dev = NULL;
    struct aicwf_rx_priv* rx_priv = NULL;
    struct aic_usb_dev *usb_dev = NULL;
    

	AICWFDBG(LOGINFO, "%s vid:0x%X pid:0x%X icl:0x%X isc:0x%X ipr:0x%X \r\n", __func__,
		id->idVendor,
		id->idProduct,
		id->bInterfaceClass,
		id->bInterfaceSubClass,
		id->bInterfaceProtocol);

	if(fw_loaded == 1 && 
        (id->idProduct == USB_DEVICE_ID_AIC_8801 || 
        id->idProduct == USB_DEVICE_ID_AIC_8800D81 ||
	    id->idProduct == USB_DEVICE_ID_AIC_8800D41 ||
	    id->idProduct == USB_DEVICE_ID_AIC_8800D81X2 ||
	    id->idProduct == USB_DEVICE_ID_AIC_8800D89X2)){
		return -1;
	}

    usb_dev = kzalloc(sizeof(struct aic_usb_dev), GFP_ATOMIC);
    if (!usb_dev) {
        return -ENOMEM;
    }

    usb_dev->udev = usb;
    usb_dev->dev = &usb->dev;
    ret = aicloadfw_chipmatch(usb_dev, id->idVendor, id->idProduct);
    if (ret) {
        AICWFDBG(LOGERROR, "%s chip unsupport.\r\n", __func__);
        goto out_free;
    }
    
    usb_set_intfdata(intf, usb_dev);

    ret = aicwf_parse_usb(usb_dev, intf, id->idProduct);
    if (ret) {
        usb_err("aicwf_parse_usb err %d\n", ret);
        goto out_free;
    }

    ret = aicwf_usb_init(usb_dev);
    if (ret) {
        usb_err("aicwf_usb_init err %d\n", ret);
        goto out_free;
    }

    bus_if = kzalloc(sizeof(struct aicwf_bus), GFP_ATOMIC);
    if (!bus_if) {
        ret = -ENOMEM;
        goto out_free_usb;
    }

    dev = usb_dev->dev;
    bus_if->dev = dev;
    usb_dev->bus_if = bus_if;
    bus_if->bus_priv.usb = usb_dev;
    dev_set_drvdata(dev, bus_if);

    bus_if->ops = &aicwf_usb_bus_ops;

    rx_priv = aicwf_rx_init(usb_dev);
    if(!rx_priv) {
        txrx_err("rx init failed\n");
        ret = -1;
        goto out_free_bus;
    }
    usb_dev->rx_priv = rx_priv;

    ret = aicwf_bus_init(0, dev);
    if (ret < 0) {
        usb_err("aicwf_bus_init err %d\n", ret);
        goto out_free_bus;
    }

    ret = aicwf_bus_start(bus_if);
    if (ret < 0) {
        usb_err("aicwf_bus_start err %d\n", ret);
        goto out_free_bus;
    }

    aic_bt_platform_init(usb_dev);

    if ((usb->speed != USB_SPEED_HIGH) && (usb->speed != USB_SPEED_SUPER)) {
        printk("Aic USB device detected speed = %d\n", usb->speed);
        system_reboot(usb_dev);
        goto out_free_bus;
    }

	if(fw_loaded == 0 && 
        (usb_dev->chipid == PRODUCT_ID_AIC8801 ||
        usb_dev->chipid == PRODUCT_ID_AIC8800D81||
        usb_dev->chipid == PRODUCT_ID_AIC8800D81X2 ||
        usb_dev->chipid == PRODUCT_ID_AIC8800D89X2)){
		rwnx_send_reboot(usb_dev);
		goto out_free_bus;
	}

    if (system_config(usb_dev)) {
        goto out_free_bus;
    }

    if (aicfw_download_fw(usb_dev)){
        goto out_free_bus;
    }
    
    usb_dev->app_cmp = true;
	fw_loaded = 1;

    return 0;

out_free_bus:
	aicwf_bus_deinit(dev);
	aicwf_rx_deinit(usb_dev->rx_priv);
    kfree(bus_if);
out_free_usb:
    aicwf_usb_deinit(usb_dev);
out_free:
    usb_err("failed with errno %d\n", ret);
    kfree(usb_dev);
    usb_set_intfdata(intf, NULL);
    return ret;
}

static void aicwf_usb_disconnect(struct usb_interface *intf)
{
    struct aic_usb_dev *usb_dev =
            (struct aic_usb_dev *) usb_get_intfdata(intf);

	printk("%s enter \r\n", __func__);

    if (!usb_dev)
        return;

    aicwf_bus_deinit(usb_dev->dev);
    aicwf_usb_deinit(usb_dev);
    if (usb_dev->rx_priv)
        aicwf_rx_deinit(usb_dev->rx_priv);
    kfree(usb_dev->bus_if);
    kfree(usb_dev);
}
#if 0
static int aicwf_usb_suspend(struct usb_interface *intf, pm_message_t state)
{
    struct aic_usb_dev *usb_dev =
        (struct aic_usb_dev *) usb_get_intfdata(intf);

    aicwf_usb_state_change(usb_dev, USB_SLEEP_ST);
    aicwf_bus_stop(usb_dev->bus_if);
    return 0;
}

static int aicwf_usb_resume(struct usb_interface *intf)
{
    struct aic_usb_dev *usb_dev =
        (struct aic_usb_dev *) usb_get_intfdata(intf);

    if (usb_dev->state == USB_UP_ST)
        return 0;

    aicwf_bus_start(usb_dev->bus_if);
    return 0;
}

static int aicwf_usb_reset_resume(struct usb_interface *intf)
{
    return aicwf_usb_resume(intf);
}
#endif
static struct usb_device_id aicwf_usb_id_table[] = {
    {USB_DEVICE(USB_VENDOR_ID_AIC, USB_DEVICE_ID_AIC)},
    {USB_DEVICE(USB_VENDOR_ID_AIC, USB_DEVICE_ID_AIC_8801)},
    {USB_DEVICE(USB_VENDOR_ID_AIC, USB_DEVICE_ID_AIC_8800D80)},
    {USB_DEVICE(USB_VENDOR_ID_AIC, USB_DEVICE_ID_AIC_8800D81)},
    {USB_DEVICE(USB_VENDOR_ID_AIC, USB_DEVICE_ID_AIC_8800D40)},
    {USB_DEVICE(USB_VENDOR_ID_AIC, USB_DEVICE_ID_AIC_8800D41)},
    {USB_DEVICE(USB_VENDOR_ID_AIC_V2, USB_DEVICE_ID_AIC_8800D80X2)},
    {USB_DEVICE(USB_VENDOR_ID_AIC_V2, USB_DEVICE_ID_AIC_8800D81X2)},
    {USB_DEVICE(USB_VENDOR_ID_AIC_V2, USB_DEVICE_ID_AIC_8800D89X2)},
    {USB_DEVICE(USB_VENDOR_ID_AIC_V2, USB_DEVICE_ID_AIC_8800D40X2)},
    {}
};

MODULE_DEVICE_TABLE(usb, aicwf_usb_id_table);

static struct usb_driver aicwf_usbdrvr = {
    .name = KBUILD_MODNAME,
    .probe = aicwf_usb_probe,
    .disconnect = aicwf_usb_disconnect,
    .id_table = aicwf_usb_id_table,
    //.suspend = aicwf_usb_suspend,
    //.resume = aicwf_usb_resume,
    //.reset_resume = aicwf_usb_reset_resume,
    .supports_autosuspend = 0,
    .disable_hub_initiated_lpm = 1,
};

void aicwf_usb_register(void)
{
    if (usb_register(&aicwf_usbdrvr) < 0) {
        usb_err("usb_register failed\n");
    }
}

void aicwf_usb_exit(void)
{
    usb_deregister(&aicwf_usbdrvr);
}
