/*
   BlueZ - Bluetooth protocol stack for Linux
   Copyright (C) 2000-2001 Qualcomm Incorporated
   Copyright (C) 2011 ProFUSION Embedded Systems

   Written 2000,2001 by Maxim Krasnyansky <maxk@qualcomm.com>

   This program is free software; you can redistribute it and/or modify
   it under the terms of the GNU General Public License version 2 as
   published by the Free Software Foundation;

   THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
   OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
   FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS.
   IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY
   CLAIM, OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES
   WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
   ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
   OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.

   ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS,
   COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS
   SOFTWARE IS DISCLAIMED.
*/

/* Bluetooth HCI core. */

#include <linux/export.h>
#include <linux/idr.h>

#include <linux/rfkill.h>

#include <net/bluetooth/bluetooth.h>
#include <net/bluetooth/hci_core.h>

static void hci_rx_work(struct work_struct *work);
static void hci_cmd_work(struct work_struct *work);
static void hci_tx_work(struct work_struct *work);

/* HCI device list */
LIST_HEAD(hci_dev_list);
DEFINE_RWLOCK(hci_dev_list_lock);

/* HCI callback list */
LIST_HEAD(hci_cb_list);
DEFINE_RWLOCK(hci_cb_list_lock);

/* HCI ID Numbering */
static DEFINE_IDA(hci_index_ida);

/* ---- HCI notifications ---- */

static void hci_notify(struct hci_dev *hdev, int event)
{
        hci_sock_dev_event(hdev, event);
}

/* ---- HCI requests ---- */

void hci_req_complete(struct hci_dev *hdev, __u16 cmd, int result)
{
        BT_DBG("%s command 0x%4.4x result 0x%2.2x", hdev->name, cmd, result);

        /* If this is the init phase check if the completed command matches
         * the last init command, and if not just return.
         */
        if (test_bit(HCI_INIT, &hdev->flags) && hdev->init_last_cmd != cmd) {
                struct hci_command_hdr *sent = (void *) hdev->sent_cmd->data;
                u16 opcode = __le16_to_cpu(sent->opcode);
                struct sk_buff *skb;

                /* Some CSR based controllers generate a spontaneous
                 * reset complete event during init and any pending
                 * command will never be completed. In such a case we
                 * need to resend whatever was the last sent
                 * command.
                 */

                if (cmd != HCI_OP_RESET || opcode == HCI_OP_RESET)
                        return;

                skb = skb_clone(hdev->sent_cmd, GFP_ATOMIC);
                if (skb) {
                        skb_queue_head(&hdev->cmd_q, skb);
                        queue_work(hdev->workqueue, &hdev->cmd_work);
                }

                return;
        }

        if (hdev->req_status == HCI_REQ_PEND) {
                hdev->req_result = result;
                hdev->req_status = HCI_REQ_DONE;
                wake_up_interruptible(&hdev->req_wait_q);
        }
}

static void hci_req_cancel(struct hci_dev *hdev, int err)
{
        BT_DBG("%s err 0x%2.2x", hdev->name, err);

        if (hdev->req_status == HCI_REQ_PEND) {
                hdev->req_result = err;
                hdev->req_status = HCI_REQ_CANCELED;
                wake_up_interruptible(&hdev->req_wait_q);
        }
}

/* Execute request and wait for completion. */
static int __hci_request(struct hci_dev *hdev,
                         void (*req)(struct hci_dev *hdev, unsigned long opt),
                         unsigned long opt, __u32 timeout)
{
        DECLARE_WAITQUEUE(wait, current);
        int err = 0;

        BT_DBG("%s start", hdev->name);

        hdev->req_status = HCI_REQ_PEND;

        add_wait_queue(&hdev->req_wait_q, &wait);
        set_current_state(TASK_INTERRUPTIBLE);

        req(hdev, opt);
        schedule_timeout(timeout);

        remove_wait_queue(&hdev->req_wait_q, &wait);

        if (signal_pending(current))
                return -EINTR;

        switch (hdev->req_status) {
        case HCI_REQ_DONE:
                err = -bt_to_errno(hdev->req_result);
                break;

        case HCI_REQ_CANCELED:
                err = -hdev->req_result;
                break;

        default:
                err = -ETIMEDOUT;
                break;
        }

        hdev->req_status = hdev->req_result = 0;

        BT_DBG("%s end: err %d", hdev->name, err);

        return err;
}

static int hci_request(struct hci_dev *hdev,
                       void (*req)(struct hci_dev *hdev, unsigned long opt),
                       unsigned long opt, __u32 timeout)
{
        int ret;

        if (!test_bit(HCI_UP, &hdev->flags))
                return -ENETDOWN;

        /* Serialize all requests */
        hci_req_lock(hdev);
        ret = __hci_request(hdev, req, opt, timeout);
        hci_req_unlock(hdev);

        return ret;
}

static void hci_reset_req(struct hci_dev *hdev, unsigned long opt)
{
        BT_DBG("%s %ld", hdev->name, opt);

        /* Reset device */
        set_bit(HCI_RESET, &hdev->flags);
        hci_send_cmd(hdev, HCI_OP_RESET, 0, NULL);
}

static void bredr_init(struct hci_dev *hdev)
{
        hdev->flow_ctl_mode = HCI_FLOW_CTL_MODE_PACKET_BASED;

        /* Read Local Supported Features */
        hci_send_cmd(hdev, HCI_OP_READ_LOCAL_FEATURES, 0, NULL);

        /* Read Local Version */
        hci_send_cmd(hdev, HCI_OP_READ_LOCAL_VERSION, 0, NULL);
}

static void amp_init(struct hci_dev *hdev)
{
        hdev->flow_ctl_mode = HCI_FLOW_CTL_MODE_BLOCK_BASED;

        /* Read Local Version */
        hci_send_cmd(hdev, HCI_OP_READ_LOCAL_VERSION, 0, NULL);

        /* Read Local AMP Info */
        hci_send_cmd(hdev, HCI_OP_READ_LOCAL_AMP_INFO, 0, NULL);

        /* Read Data Blk size */
        hci_send_cmd(hdev, HCI_OP_READ_DATA_BLOCK_SIZE, 0, NULL);
}

static void hci_init_req(struct hci_dev *hdev, unsigned long opt)
{
        struct sk_buff *skb;

        BT_DBG("%s %ld", hdev->name, opt);

        /* Driver initialization */

        /* Special commands */
        while ((skb = skb_dequeue(&hdev->driver_init))) {
                bt_cb(skb)->pkt_type = HCI_COMMAND_PKT;
                skb->dev = (void *) hdev;

                skb_queue_tail(&hdev->cmd_q, skb);
                queue_work(hdev->workqueue, &hdev->cmd_work);
        }
        skb_queue_purge(&hdev->driver_init);

        /* Reset */
        if (!test_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks))
                hci_reset_req(hdev, 0);

        switch (hdev->dev_type) {
        case HCI_BREDR:
                bredr_init(hdev);
                break;

        case HCI_AMP:
                amp_init(hdev);
                break;

        default:
                BT_ERR("Unknown device type %d", hdev->dev_type);
                break;
        }
}

static void hci_scan_req(struct hci_dev *hdev, unsigned long opt)
{
        __u8 scan = opt;

        BT_DBG("%s %x", hdev->name, scan);

        /* Inquiry and Page scans */
        hci_send_cmd(hdev, HCI_OP_WRITE_SCAN_ENABLE, 1, &scan);
}

static void hci_auth_req(struct hci_dev *hdev, unsigned long opt)
{
        __u8 auth = opt;

        BT_DBG("%s %x", hdev->name, auth);

        /* Authentication */
        hci_send_cmd(hdev, HCI_OP_WRITE_AUTH_ENABLE, 1, &auth);
}

static void hci_encrypt_req(struct hci_dev *hdev, unsigned long opt)
{
        __u8 encrypt = opt;

        BT_DBG("%s %x", hdev->name, encrypt);

        /* Encryption */
        hci_send_cmd(hdev, HCI_OP_WRITE_ENCRYPT_MODE, 1, &encrypt);
}

static void hci_linkpol_req(struct hci_dev *hdev, unsigned long opt)
{
        __le16 policy = cpu_to_le16(opt);

        BT_DBG("%s %x", hdev->name, policy);

        /* Default link policy */
        hci_send_cmd(hdev, HCI_OP_WRITE_DEF_LINK_POLICY, 2, &policy);
}

/* Get HCI device by index.
 * Device is held on return. */
struct hci_dev *hci_dev_get(int index)
{
        struct hci_dev *hdev = NULL, *d;

        BT_DBG("%d", index);

        if (index < 0)
                return NULL;

        read_lock(&hci_dev_list_lock);
        list_for_each_entry(d, &hci_dev_list, list) {
                if (d->id == index) {
                        hdev = hci_dev_hold(d);
                        break;
                }
        }
        read_unlock(&hci_dev_list_lock);
        return hdev;
}

/* ---- Inquiry support ---- */

bool hci_discovery_active(struct hci_dev *hdev)
{
        struct discovery_state *discov = &hdev->discovery;

        switch (discov->state) {
        case DISCOVERY_FINDING:
        case DISCOVERY_RESOLVING:
                return true;

        default:
                return false;
        }
}

void hci_discovery_set_state(struct hci_dev *hdev, int state)
{
        BT_DBG("%s state %u -> %u", hdev->name, hdev->discovery.state, state);

        if (hdev->discovery.state == state)
                return;

        switch (state) {
        case DISCOVERY_STOPPED:
                if (hdev->discovery.state != DISCOVERY_STARTING)
                        mgmt_discovering(hdev, 0);
                break;
        case DISCOVERY_STARTING:
                break;
        case DISCOVERY_FINDING:
                mgmt_discovering(hdev, 1);
                break;
        case DISCOVERY_RESOLVING:
                break;
        case DISCOVERY_STOPPING:
                break;
        }

        hdev->discovery.state = state;
}

static void inquiry_cache_flush(struct hci_dev *hdev)
{
        struct discovery_state *cache = &hdev->discovery;
        struct inquiry_entry *p, *n;

        list_for_each_entry_safe(p, n, &cache->all, all) {
                list_del(&p->all);
                kfree(p);
        }

        INIT_LIST_HEAD(&cache->unknown);
        INIT_LIST_HEAD(&cache->resolve);
}

struct inquiry_entry *hci_inquiry_cache_lookup(struct hci_dev *hdev,
                                               bdaddr_t *bdaddr)
{
        struct discovery_state *cache = &hdev->discovery;
        struct inquiry_entry *e;

        BT_DBG("cache %p, %pMR", cache, bdaddr);

        list_for_each_entry(e, &cache->all, all) {
                if (!bacmp(&e->data.bdaddr, bdaddr))
                        return e;
        }

        return NULL;
}

struct inquiry_entry *hci_inquiry_cache_lookup_unknown(struct hci_dev *hdev,
                                                       bdaddr_t *bdaddr)
{
        struct discovery_state *cache = &hdev->discovery;
        struct inquiry_entry *e;

        BT_DBG("cache %p, %pMR", cache, bdaddr);

        list_for_each_entry(e, &cache->unknown, list) {
                if (!bacmp(&e->data.bdaddr, bdaddr))
                        return e;
        }

        return NULL;
}

struct inquiry_entry *hci_inquiry_cache_lookup_resolve(struct hci_dev *hdev,
                                                       bdaddr_t *bdaddr,
                                                       int state)
{
        struct discovery_state *cache = &hdev->discovery;
        struct inquiry_entry *e;

        BT_DBG("cache %p bdaddr %pMR state %d", cache, bdaddr, state);

        list_for_each_entry(e, &cache->resolve, list) {
                if (!bacmp(bdaddr, BDADDR_ANY) && e->name_state == state)
                        return e;
                if (!bacmp(&e->data.bdaddr, bdaddr))
                        return e;
        }

        return NULL;
}

void hci_inquiry_cache_update_resolve(struct hci_dev *hdev,
                                      struct inquiry_entry *ie)
{
        struct discovery_state *cache = &hdev->discovery;
        struct list_head *pos = &cache->resolve;
        struct inquiry_entry *p;

        list_del(&ie->list);

        list_for_each_entry(p, &cache->resolve, list) {
                if (p->name_state != NAME_PENDING &&
                    abs(p->data.rssi) >= abs(ie->data.rssi))
                        break;
                pos = &p->list;
        }

        list_add(&ie->list, pos);
}

bool hci_inquiry_cache_update(struct hci_dev *hdev, struct inquiry_data *data,
                              bool name_known, bool *ssp)
{
        struct discovery_state *cache = &hdev->discovery;
        struct inquiry_entry *ie;

        BT_DBG("cache %p, %pMR", cache, &data->bdaddr);

        hci_remove_remote_oob_data(hdev, &data->bdaddr);

        if (ssp)
                *ssp = data->ssp_mode;

        ie = hci_inquiry_cache_lookup(hdev, &data->bdaddr);
        if (ie) {
                if (ie->data.ssp_mode && ssp)
                        *ssp = true;

                if (ie->name_state == NAME_NEEDED &&
                    data->rssi != ie->data.rssi) {
                        ie->data.rssi = data->rssi;
                        hci_inquiry_cache_update_resolve(hdev, ie);
                }

                goto update;
        }

        /* Entry not in the cache. Add new one. */
        ie = kzalloc(sizeof(struct inquiry_entry), GFP_ATOMIC);
        if (!ie)
                return false;

        list_add(&ie->all, &cache->all);

        if (name_known) {
                ie->name_state = NAME_KNOWN;
        } else {
                ie->name_state = NAME_NOT_KNOWN;
                list_add(&ie->list, &cache->unknown);
        }

update:
        if (name_known && ie->name_state != NAME_KNOWN &&
            ie->name_state != NAME_PENDING) {
                ie->name_state = NAME_KNOWN;
                list_del(&ie->list);
        }

        memcpy(&ie->data, data, sizeof(*data));
        ie->timestamp = jiffies;
        cache->timestamp = jiffies;

        if (ie->name_state == NAME_NOT_KNOWN)
                return false;

        return true;
}

static int inquiry_cache_dump(struct hci_dev *hdev, int num, __u8 *buf)
{
        struct discovery_state *cache = &hdev->discovery;
        struct inquiry_info *info = (struct inquiry_info *) buf;
        struct inquiry_entry *e;
        int copied = 0;

        list_for_each_entry(e, &cache->all, all) {
                struct inquiry_data *data = &e->data;

                if (copied >= num)
                        break;

                bacpy(&info->bdaddr, &data->bdaddr);
                info->pscan_rep_mode    = data->pscan_rep_mode;
                info->pscan_period_mode = data->pscan_period_mode;
                info->pscan_mode        = data->pscan_mode;
                memcpy(info->dev_class, data->dev_class, 3);
                info->clock_offset      = data->clock_offset;

                info++;
                copied++;
        }

        BT_DBG("cache %p, copied %d", cache, copied);
        return copied;
}

static void hci_inq_req(struct hci_dev *hdev, unsigned long opt)
{
        struct hci_inquiry_req *ir = (struct hci_inquiry_req *) opt;
        struct hci_cp_inquiry cp;

        BT_DBG("%s", hdev->name);

        if (test_bit(HCI_INQUIRY, &hdev->flags))
                return;

        /* Start Inquiry */
        memcpy(&cp.lap, &ir->lap, 3);
        cp.length  = ir->length;
        cp.num_rsp = ir->num_rsp;
        hci_send_cmd(hdev, HCI_OP_INQUIRY, sizeof(cp), &cp);
}

int hci_inquiry(void __user *arg)
{
        __u8 __user *ptr = arg;
        struct hci_inquiry_req ir;
        struct hci_dev *hdev;
        int err = 0, do_inquiry = 0, max_rsp;
        long timeo;
        __u8 *buf;

        if (copy_from_user(&ir, ptr, sizeof(ir)))
                return -EFAULT;

        hdev = hci_dev_get(ir.dev_id);
        if (!hdev)
                return -ENODEV;

        hci_dev_lock(hdev);
        if (inquiry_cache_age(hdev) > INQUIRY_CACHE_AGE_MAX ||
            inquiry_cache_empty(hdev) || ir.flags & IREQ_CACHE_FLUSH) {
                inquiry_cache_flush(hdev);
                do_inquiry = 1;
        }
        hci_dev_unlock(hdev);

        timeo = ir.length * msecs_to_jiffies(2000);

        if (do_inquiry) {
                err = hci_request(hdev, hci_inq_req, (unsigned long)&ir, timeo);
                if (err < 0)
                        goto done;
        }

        /* for unlimited number of responses we will use buffer with
         * 255 entries
         */
        max_rsp = (ir.num_rsp == 0) ? 255 : ir.num_rsp;

        /* cache_dump can't sleep. Therefore we allocate temp buffer and then
         * copy it to the user space.
         */
        buf = kmalloc(sizeof(struct inquiry_info) * max_rsp, GFP_KERNEL);
        if (!buf) {
                err = -ENOMEM;
                goto done;
        }

        hci_dev_lock(hdev);
        ir.num_rsp = inquiry_cache_dump(hdev, max_rsp, buf);
        hci_dev_unlock(hdev);

        BT_DBG("num_rsp %d", ir.num_rsp);

        if (!copy_to_user(ptr, &ir, sizeof(ir))) {
                ptr += sizeof(ir);
                if (copy_to_user(ptr, buf, sizeof(struct inquiry_info) *
                                 ir.num_rsp))
                        err = -EFAULT;
        } else
                err = -EFAULT;

        kfree(buf);

done:
        hci_dev_put(hdev);
        return err;
}

static u8 create_ad(struct hci_dev *hdev, u8 *ptr)
{
        u8 ad_len = 0, flags = 0;
        size_t name_len;

        if (test_bit(HCI_LE_PERIPHERAL, &hdev->dev_flags))
                flags |= LE_AD_GENERAL;

        if (!lmp_bredr_capable(hdev))
                flags |= LE_AD_NO_BREDR;

        if (lmp_le_br_capable(hdev))
                flags |= LE_AD_SIM_LE_BREDR_CTRL;

        if (lmp_host_le_br_capable(hdev))
                flags |= LE_AD_SIM_LE_BREDR_HOST;

        if (flags) {
                BT_DBG("adv flags 0x%02x", flags);

                ptr[0] = 2;
                ptr[1] = EIR_FLAGS;
                ptr[2] = flags;

                ad_len += 3;
                ptr += 3;
        }

        if (hdev->adv_tx_power != HCI_TX_POWER_INVALID) {
                ptr[0] = 2;
                ptr[1] = EIR_TX_POWER;
                ptr[2] = (u8) hdev->adv_tx_power;

                ad_len += 3;
                ptr += 3;
        }

        name_len = strlen(hdev->dev_name);
        if (name_len > 0) {
                size_t max_len = HCI_MAX_AD_LENGTH - ad_len - 2;

                if (name_len > max_len) {
                        name_len = max_len;
                        ptr[1] = EIR_NAME_SHORT;
                } else
                        ptr[1] = EIR_NAME_COMPLETE;

                ptr[0] = name_len + 1;

                memcpy(ptr + 2, hdev->dev_name, name_len);

                ad_len += (name_len + 2);
                ptr += (name_len + 2);
        }

        return ad_len;
}

int hci_update_ad(struct hci_dev *hdev)
{
        struct hci_cp_le_set_adv_data cp;
        u8 len;
        int err;

        hci_dev_lock(hdev);

        if (!lmp_le_capable(hdev)) {
                err = -EINVAL;
                goto unlock;
        }

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

        len = create_ad(hdev, cp.data);

        if (hdev->adv_data_len == len &&
            memcmp(cp.data, hdev->adv_data, len) == 0) {
                err = 0;
                goto unlock;
        }

        memcpy(hdev->adv_data, cp.data, sizeof(cp.data));
        hdev->adv_data_len = len;

        cp.length = len;
        err = hci_send_cmd(hdev, HCI_OP_LE_SET_ADV_DATA, sizeof(cp), &cp);

unlock:
        hci_dev_unlock(hdev);

        return err;
}

/* ---- HCI ioctl helpers ---- */

int hci_dev_open(__u16 dev)
{
        struct hci_dev *hdev;
        int ret = 0;

        hdev = hci_dev_get(dev);
        if (!hdev)
                return -ENODEV;

        BT_DBG("%s %p", hdev->name, hdev);

        hci_req_lock(hdev);

        if (test_bit(HCI_UNREGISTER, &hdev->dev_flags)) {
                ret = -ENODEV;
                goto done;
        }

        if (hdev->rfkill && rfkill_blocked(hdev->rfkill)) {
                ret = -ERFKILL;
                goto done;
        }

        if (test_bit(HCI_UP, &hdev->flags)) {
                ret = -EALREADY;
                goto done;
        }

        if (test_bit(HCI_QUIRK_RAW_DEVICE, &hdev->quirks))
                set_bit(HCI_RAW, &hdev->flags);

        /* Treat all non BR/EDR controllers as raw devices if
           enable_hs is not set */
        if (hdev->dev_type != HCI_BREDR && !enable_hs)
                set_bit(HCI_RAW, &hdev->flags);

        if (hdev->open(hdev)) {
                ret = -EIO;
                goto done;
        }

        if (!test_bit(HCI_RAW, &hdev->flags)) {
                atomic_set(&hdev->cmd_cnt, 1);
                set_bit(HCI_INIT, &hdev->flags);
                hdev->init_last_cmd = 0;

                ret = __hci_request(hdev, hci_init_req, 0, HCI_INIT_TIMEOUT);

                clear_bit(HCI_INIT, &hdev->flags);
        }

        if (!ret) {
                hci_dev_hold(hdev);
                set_bit(HCI_UP, &hdev->flags);
                hci_notify(hdev, HCI_DEV_UP);
                hci_update_ad(hdev);
                if (!test_bit(HCI_SETUP, &hdev->dev_flags) &&
                    mgmt_valid_hdev(hdev)) {
                        hci_dev_lock(hdev);
                        mgmt_powered(hdev, 1);
                        hci_dev_unlock(hdev);
                }
        } else {
                /* Init failed, cleanup */
                flush_work(&hdev->tx_work);
                flush_work(&hdev->cmd_work);
                flush_work(&hdev->rx_work);

                skb_queue_purge(&hdev->cmd_q);
                skb_queue_purge(&hdev->rx_q);

                if (hdev->flush)
                        hdev->flush(hdev);

                if (hdev->sent_cmd) {
                        kfree_skb(hdev->sent_cmd);
                        hdev->sent_cmd = NULL;
                }

                hdev->close(hdev);
                hdev->flags = 0;
        }

done:
        hci_req_unlock(hdev);
        hci_dev_put(hdev);
        return ret;
}

static int hci_dev_do_close(struct hci_dev *hdev)
{
        BT_DBG("%s %p", hdev->name, hdev);

        cancel_work_sync(&hdev->le_scan);

        cancel_delayed_work(&hdev->power_off);

        hci_req_cancel(hdev, ENODEV);
        hci_req_lock(hdev);

        if (!test_and_clear_bit(HCI_UP, &hdev->flags)) {
                del_timer_sync(&hdev->cmd_timer);
                hci_req_unlock(hdev);
                return 0;
        }

        /* Flush RX and TX works */
        flush_work(&hdev->tx_work);
        flush_work(&hdev->rx_work);

        if (hdev->discov_timeout > 0) {
                cancel_delayed_work(&hdev->discov_off);
                hdev->discov_timeout = 0;
                clear_bit(HCI_DISCOVERABLE, &hdev->dev_flags);
        }

        if (test_and_clear_bit(HCI_SERVICE_CACHE, &hdev->dev_flags))
                cancel_delayed_work(&hdev->service_cache);

        cancel_delayed_work_sync(&hdev->le_scan_disable);

        hci_dev_lock(hdev);
        inquiry_cache_flush(hdev);
        hci_conn_hash_flush(hdev);
        hci_dev_unlock(hdev);

        hci_notify(hdev, HCI_DEV_DOWN);

        if (hdev->flush)
                hdev->flush(hdev);

        /* Reset device */
        skb_queue_purge(&hdev->cmd_q);
        atomic_set(&hdev->cmd_cnt, 1);
        if (!test_bit(HCI_RAW, &hdev->flags) &&
            test_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks)) {
                set_bit(HCI_INIT, &hdev->flags);
                __hci_request(hdev, hci_reset_req, 0, HCI_CMD_TIMEOUT);
                clear_bit(HCI_INIT, &hdev->flags);
        }

        /* flush cmd  work */
        flush_work(&hdev->cmd_work);

        /* Drop queues */
        skb_queue_purge(&hdev->rx_q);
        skb_queue_purge(&hdev->cmd_q);
        skb_queue_purge(&hdev->raw_q);

        /* Drop last sent command */
        if (hdev->sent_cmd) {
                del_timer_sync(&hdev->cmd_timer);
                kfree_skb(hdev->sent_cmd);
                hdev->sent_cmd = NULL;
        }

        /* After this point our queues are empty
         * and no tasks are scheduled. */
        hdev->close(hdev);

        if (!test_and_clear_bit(HCI_AUTO_OFF, &hdev->dev_flags) &&
            mgmt_valid_hdev(hdev)) {
                hci_dev_lock(hdev);
                mgmt_powered(hdev, 0);
                hci_dev_unlock(hdev);
        }

        /* Clear flags */
        hdev->flags = 0;

        /* Controller radio is available but is currently powered down */
        hdev->amp_status = 0;

        memset(hdev->eir, 0, sizeof(hdev->eir));
        memset(hdev->dev_class, 0, sizeof(hdev->dev_class));

        hci_req_unlock(hdev);

        hci_dev_put(hdev);
        return 0;
}

int hci_dev_close(__u16 dev)
{
        struct hci_dev *hdev;
        int err;

        hdev = hci_dev_get(dev);
        if (!hdev)
                return -ENODEV;

        if (test_and_clear_bit(HCI_AUTO_OFF, &hdev->dev_flags))
                cancel_delayed_work(&hdev->power_off);

        err = hci_dev_do_close(hdev);

        hci_dev_put(hdev);
        return err;
}

int hci_dev_reset(__u16 dev)
{
        struct hci_dev *hdev;
        int ret = 0;

        hdev = hci_dev_get(dev);
        if (!hdev)
                return -ENODEV;

        hci_req_lock(hdev);

        if (!test_bit(HCI_UP, &hdev->flags))
                goto done;

        /* Drop queues */
        skb_queue_purge(&hdev->rx_q);
        skb_queue_purge(&hdev->cmd_q);

        hci_dev_lock(hdev);
        inquiry_cache_flush(hdev);
        hci_conn_hash_flush(hdev);
        hci_dev_unlock(hdev);

        if (hdev->flush)
                hdev->flush(hdev);

        atomic_set(&hdev->cmd_cnt, 1);
        hdev->acl_cnt = 0; hdev->sco_cnt = 0; hdev->le_cnt = 0;

        if (!test_bit(HCI_RAW, &hdev->flags))
                ret = __hci_request(hdev, hci_reset_req, 0, HCI_INIT_TIMEOUT);

done:
        hci_req_unlock(hdev);
        hci_dev_put(hdev);
        return ret;
}

int hci_dev_reset_stat(__u16 dev)
{
        struct hci_dev *hdev;
        int ret = 0;

        hdev = hci_dev_get(dev);
        if (!hdev)
                return -ENODEV;

        memset(&hdev->stat, 0, sizeof(struct hci_dev_stats));

        hci_dev_put(hdev);

        return ret;
}

int hci_dev_cmd(unsigned int cmd, void __user *arg)
{
        struct hci_dev *hdev;
        struct hci_dev_req dr;
        int err = 0;

        if (copy_from_user(&dr, arg, sizeof(dr)))
                return -EFAULT;

        hdev = hci_dev_get(dr.dev_id);
        if (!hdev)
                return -ENODEV;

        switch (cmd) {
        case HCISETAUTH:
                err = hci_request(hdev, hci_auth_req, dr.dev_opt,
                                  HCI_INIT_TIMEOUT);
                break;

        case HCISETENCRYPT:
                if (!lmp_encrypt_capable(hdev)) {
                        err = -EOPNOTSUPP;
                        break;
                }

                if (!test_bit(HCI_AUTH, &hdev->flags)) {
                        /* Auth must be enabled first */
                        err = hci_request(hdev, hci_auth_req, dr.dev_opt,
                                          HCI_INIT_TIMEOUT);
                        if (err)
                                break;
                }

                err = hci_request(hdev, hci_encrypt_req, dr.dev_opt,
                                  HCI_INIT_TIMEOUT);
                break;

        case HCISETSCAN:
                err = hci_request(hdev, hci_scan_req, dr.dev_opt,
                                  HCI_INIT_TIMEOUT);
                break;

        case HCISETLINKPOL:
                err = hci_request(hdev, hci_linkpol_req, dr.dev_opt,
                                  HCI_INIT_TIMEOUT);
                break;

        case HCISETLINKMODE:
                hdev->link_mode = ((__u16) dr.dev_opt) &
                                        (HCI_LM_MASTER | HCI_LM_ACCEPT);
                break;

        case HCISETPTYPE:

                hdev->pkt_type = (__u16) dr.dev_opt;
                break;

        case HCISETACLMTU:
                hdev->acl_mtu  = *((__u16 *) &dr.dev_opt + 1);
                hdev->acl_pkts = *((__u16 *) &dr.dev_opt + 0);
                break;

        case HCISETSCOMTU:
                hdev->sco_mtu  = *((__u16 *) &dr.dev_opt + 1);
                hdev->sco_pkts = *((__u16 *) &dr.dev_opt + 0);
                break;

        default:
                err = -EINVAL;
                break;
        }

        hci_dev_put(hdev);
        return err;
}

int hci_get_dev_list(void __user *arg)
{
        struct hci_dev *hdev;
        struct hci_dev_list_req *dl;
        struct hci_dev_req *dr;
        int n = 0, size, err;
        __u16 dev_num;

        if (get_user(dev_num, (__u16 __user *) arg))
                return -EFAULT;

        if (!dev_num || dev_num > (PAGE_SIZE * 2) / sizeof(*dr))
                return -EINVAL;

        size = sizeof(*dl) + dev_num * sizeof(*dr);

        dl = kzalloc(size, GFP_KERNEL);
        if (!dl)
                return -ENOMEM;

        dr = dl->dev_req;

        read_lock(&hci_dev_list_lock);
        list_for_each_entry(hdev, &hci_dev_list, list) {
                if (test_and_clear_bit(HCI_AUTO_OFF, &hdev->dev_flags))
                        cancel_delayed_work(&hdev->power_off);

                if (!test_bit(HCI_MGMT, &hdev->dev_flags))
                        set_bit(HCI_PAIRABLE, &hdev->dev_flags);

                (dr + n)->dev_id  = hdev->id;
                (dr + n)->dev_opt = hdev->flags;

                if (++n >= dev_num)
                        break;
        }
        read_unlock(&hci_dev_list_lock);

        dl->dev_num = n;
        size = sizeof(*dl) + n * sizeof(*dr);

        err = copy_to_user(arg, dl, size);
        kfree(dl);

        return err ? -EFAULT : 0;
}

int hci_get_dev_info(void __user *arg)
{
        struct hci_dev *hdev;
        struct hci_dev_info di;
        int err = 0;

        if (copy_from_user(&di, arg, sizeof(di)))
                return -EFAULT;

        hdev = hci_dev_get(di.dev_id);
        if (!hdev)
                return -ENODEV;

        if (test_and_clear_bit(HCI_AUTO_OFF, &hdev->dev_flags))
                cancel_delayed_work_sync(&hdev->power_off);

        if (!test_bit(HCI_MGMT, &hdev->dev_flags))
                set_bit(HCI_PAIRABLE, &hdev->dev_flags);

        strcpy(di.name, hdev->name);
        di.bdaddr   = hdev->bdaddr;
        di.type     = (hdev->bus & 0x0f) | (hdev->dev_type << 4);
        di.flags    = hdev->flags;
        di.pkt_type = hdev->pkt_type;
        if (lmp_bredr_capable(hdev)) {
                di.acl_mtu  = hdev->acl_mtu;
                di.acl_pkts = hdev->acl_pkts;
                di.sco_mtu  = hdev->sco_mtu;
                di.sco_pkts = hdev->sco_pkts;
        } else {
                di.acl_mtu  = hdev->le_mtu;
                di.acl_pkts = hdev->le_pkts;
                di.sco_mtu  = 0;
                di.sco_pkts = 0;
        }
        di.link_policy = hdev->link_policy;
        di.link_mode   = hdev->link_mode;

        memcpy(&di.stat, &hdev->stat, sizeof(di.stat));
        memcpy(&di.features, &hdev->features, sizeof(di.features));

        if (copy_to_user(arg, &di, sizeof(di)))
                err = -EFAULT;

        hci_dev_put(hdev);

        return err;
}

/* ---- Interface to HCI drivers ---- */

static int hci_rfkill_set_block(void *data, bool blocked)
{
        struct hci_dev *hdev = data;

        BT_DBG("%p name %s blocked %d", hdev, hdev->name, blocked);

        if (!blocked)
                return 0;

        hci_dev_do_close(hdev);

        return 0;
}

static const struct rfkill_ops hci_rfkill_ops = {
        .set_block = hci_rfkill_set_block,
};

static void hci_power_on(struct work_struct *work)
{
        struct hci_dev *hdev = container_of(work, struct hci_dev, power_on);

        BT_DBG("%s", hdev->name);

        if (hci_dev_open(hdev->id) < 0)
                return;

        if (test_bit(HCI_AUTO_OFF, &hdev->dev_flags))
                schedule_delayed_work(&hdev->power_off, HCI_AUTO_OFF_TIMEOUT);

        if (test_and_clear_bit(HCI_SETUP, &hdev->dev_flags))
                mgmt_index_added(hdev);
}

static void hci_power_off(struct work_struct *work)
{
        struct hci_dev *hdev = container_of(work, struct hci_dev,
                                            power_off.work);

        BT_DBG("%s", hdev->name);

        hci_dev_do_close(hdev);
}

static void hci_discov_off(struct work_struct *work)
{
        struct hci_dev *hdev;
        u8 scan = SCAN_PAGE;

        hdev = container_of(work, struct hci_dev, discov_off.work);

        BT_DBG("%s", hdev->name);

        hci_dev_lock(hdev);

        hci_send_cmd(hdev, HCI_OP_WRITE_SCAN_ENABLE, sizeof(scan), &scan);

        hdev->discov_timeout = 0;

        hci_dev_unlock(hdev);
}

int hci_uuids_clear(struct hci_dev *hdev)
{
        struct list_head *p, *n;

        list_for_each_safe(p, n, &hdev->uuids) {
                struct bt_uuid *uuid;

                uuid = list_entry(p, struct bt_uuid, list);

                list_del(p);
                kfree(uuid);
        }

        return 0;
}

int hci_link_keys_clear(struct hci_dev *hdev)
{
        struct list_head *p, *n;

        list_for_each_safe(p, n, &hdev->link_keys) {
                struct link_key *key;

                key = list_entry(p, struct link_key, list);

                list_del(p);
                kfree(key);
        }

        return 0;
}

int hci_smp_ltks_clear(struct hci_dev *hdev)
{
        struct smp_ltk *k, *tmp;

        list_for_each_entry_safe(k, tmp, &hdev->long_term_keys, list) {
                list_del(&k->list);
                kfree(k);
        }

        return 0;
}

struct link_key *hci_find_link_key(struct hci_dev *hdev, bdaddr_t *bdaddr)
{
        struct link_key *k;

        list_for_each_entry(k, &hdev->link_keys, list)
                if (bacmp(bdaddr, &k->bdaddr) == 0)
                        return k;

        return NULL;
}

static bool hci_persistent_key(struct hci_dev *hdev, struct hci_conn *conn,
                               u8 key_type, u8 old_key_type)
{
        /* Legacy key */
        if (key_type < 0x03)
                return true;

        /* Debug keys are insecure so don't store them persistently */
        if (key_type == HCI_LK_DEBUG_COMBINATION)
                return false;

        /* Changed combination key and there's no previous one */
        if (key_type == HCI_LK_CHANGED_COMBINATION && old_key_type == 0xff)
                return false;

        /* Security mode 3 case */
        if (!conn)
                return true;

        /* Neither local nor remote side had no-bonding as requirement */
        if (conn->auth_type > 0x01 && conn->remote_auth > 0x01)
                return true;

        /* Local side had dedicated bonding as requirement */
        if (conn->auth_type == 0x02 || conn->auth_type == 0x03)
                return true;

        /* Remote side had dedicated bonding as requirement */
        if (conn->remote_auth == 0x02 || conn->remote_auth == 0x03)
                return true;

        /* If none of the above criteria match, then don't store the key
         * persistently */
        return false;
}

struct smp_ltk *hci_find_ltk(struct hci_dev *hdev, __le16 ediv, u8 rand[8])
{
        struct smp_ltk *k;

        list_for_each_entry(k, &hdev->long_term_keys, list) {
                if (k->ediv != ediv ||
                    memcmp(rand, k->rand, sizeof(k->rand)))
                        continue;

                return k;
        }

        return NULL;
}

struct smp_ltk *hci_find_ltk_by_addr(struct hci_dev *hdev, bdaddr_t *bdaddr,
                                     u8 addr_type)
{
        struct smp_ltk *k;

        list_for_each_entry(k, &hdev->long_term_keys, list)
                if (addr_type == k->bdaddr_type &&
                    bacmp(bdaddr, &k->bdaddr) == 0)
                        return k;

        return NULL;
}

int hci_add_link_key(struct hci_dev *hdev, struct hci_conn *conn, int new_key,
                     bdaddr_t *bdaddr, u8 *val, u8 type, u8 pin_len)
{
        struct link_key *key, *old_key;
        u8 old_key_type;
        bool persistent;

        old_key = hci_find_link_key(hdev, bdaddr);
        if (old_key) {
                old_key_type = old_key->type;
                key = old_key;
        } else {
                old_key_type = conn ? conn->key_type : 0xff;
                key = kzalloc(sizeof(*key), GFP_ATOMIC);
                if (!key)
                        return -ENOMEM;
                list_add(&key->list, &hdev->link_keys);
        }

        BT_DBG("%s key for %pMR type %u", hdev->name, bdaddr, type);

        /* Some buggy controller combinations generate a changed
         * combination key for legacy pairing even when there's no
         * previous key */
        if (type == HCI_LK_CHANGED_COMBINATION &&
            (!conn || conn->remote_auth == 0xff) && old_key_type == 0xff) {
                type = HCI_LK_COMBINATION;
                if (conn)
                        conn->key_type = type;
        }

        bacpy(&key->bdaddr, bdaddr);
        memcpy(key->val, val, HCI_LINK_KEY_SIZE);
        key->pin_len = pin_len;

        if (type == HCI_LK_CHANGED_COMBINATION)
                key->type = old_key_type;
        else
                key->type = type;

        if (!new_key)
                return 0;

        persistent = hci_persistent_key(hdev, conn, type, old_key_type);

        mgmt_new_link_key(hdev, key, persistent);

        if (conn)
                conn->flush_key = !persistent;

        return 0;
}

int hci_add_ltk(struct hci_dev *hdev, bdaddr_t *bdaddr, u8 addr_type, u8 type,
                int new_key, u8 authenticated, u8 tk[16], u8 enc_size, __le16
                ediv, u8 rand[8])
{
        struct smp_ltk *key, *old_key;

        if (!(type & HCI_SMP_STK) && !(type & HCI_SMP_LTK))
                return 0;

        old_key = hci_find_ltk_by_addr(hdev, bdaddr, addr_type);
        if (old_key)
                key = old_key;
        else {
                key = kzalloc(sizeof(*key), GFP_ATOMIC);
                if (!key)
                        return -ENOMEM;
                list_add(&key->list, &hdev->long_term_keys);
        }

        bacpy(&key->bdaddr, bdaddr);
        key->bdaddr_type = addr_type;
        memcpy(key->val, tk, sizeof(key->val));
        key->authenticated = authenticated;
        key->ediv = ediv;
        key->enc_size = enc_size;
        key->type = type;
        memcpy(key->rand, rand, sizeof(key->rand));

        if (!new_key)
                return 0;

        if (type & HCI_SMP_LTK)
                mgmt_new_ltk(hdev, key, 1);

        return 0;
}

int hci_remove_link_key(struct hci_dev *hdev, bdaddr_t *bdaddr)
{
        struct link_key *key;

        key = hci_find_link_key(hdev, bdaddr);
        if (!key)
                return -ENOENT;

        BT_DBG("%s removing %pMR", hdev->name, bdaddr);

        list_del(&key->list);
        kfree(key);

        return 0;
}

int hci_remove_ltk(struct hci_dev *hdev, bdaddr_t *bdaddr)
{
        struct smp_ltk *k, *tmp;

        list_for_each_entry_safe(k, tmp, &hdev->long_term_keys, list) {
                if (bacmp(bdaddr, &k->bdaddr))
                        continue;

                BT_DBG("%s removing %pMR", hdev->name, bdaddr);

                list_del(&k->list);
                kfree(k);
        }

        return 0;
}

/* HCI command timer function */
static void hci_cmd_timeout(unsigned long arg)
{
        struct hci_dev *hdev = (void *) arg;

        if (hdev->sent_cmd) {
                struct hci_command_hdr *sent = (void *) hdev->sent_cmd->data;
                u16 opcode = __le16_to_cpu(sent->opcode);

                BT_ERR("%s command 0x%4.4x tx timeout", hdev->name, opcode);
        } else {
                BT_ERR("%s command tx timeout", hdev->name);
        }

        atomic_set(&hdev->cmd_cnt, 1);
        queue_work(hdev->workqueue, &hdev->cmd_work);
}

struct oob_data *hci_find_remote_oob_data(struct hci_dev *hdev,
                                          bdaddr_t *bdaddr)
{
        struct oob_data *data;

        list_for_each_entry(data, &hdev->remote_oob_data, list)
                if (bacmp(bdaddr, &data->bdaddr) == 0)
                        return data;

        return NULL;
}

int hci_remove_remote_oob_data(struct hci_dev *hdev, bdaddr_t *bdaddr)
{
        struct oob_data *data;

        data = hci_find_remote_oob_data(hdev, bdaddr);
        if (!data)
                return -ENOENT;

        BT_DBG("%s removing %pMR", hdev->name, bdaddr);

        list_del(&data->list);
        kfree(data);

        return 0;
}

int hci_remote_oob_data_clear(struct hci_dev *hdev)
{
        struct oob_data *data, *n;

        list_for_each_entry_safe(data, n, &hdev->remote_oob_data, list) {
                list_del(&data->list);
                kfree(data);
        }

        return 0;
}

int hci_add_remote_oob_data(struct hci_dev *hdev, bdaddr_t *bdaddr, u8 *hash,
                            u8 *randomizer)
{
        struct oob_data *data;

        data = hci_find_remote_oob_data(hdev, bdaddr);

        if (!data) {
                data = kmalloc(sizeof(*data), GFP_ATOMIC);
                if (!data)
                        return -ENOMEM;

                bacpy(&data->bdaddr, bdaddr);
                list_add(&data->list, &hdev->remote_oob_data);
        }

        memcpy(data->hash, hash, sizeof(data->hash));
        memcpy(data->randomizer, randomizer, sizeof(data->randomizer));

        BT_DBG("%s for %pMR", hdev->name, bdaddr);

        return 0;
}

struct bdaddr_list *hci_blacklist_lookup(struct hci_dev *hdev, bdaddr_t *bdaddr)
{
        struct bdaddr_list *b;

        list_for_each_entry(b, &hdev->blacklist, list)
                if (bacmp(bdaddr, &b->bdaddr) == 0)
                        return b;

        return NULL;
}

int hci_blacklist_clear(struct hci_dev *hdev)
{
        struct list_head *p, *n;

        list_for_each_safe(p, n, &hdev->blacklist) {
                struct bdaddr_list *b;

                b = list_entry(p, struct bdaddr_list, list);

                list_del(p);
                kfree(b);
        }

        return 0;
}

int hci_blacklist_add(struct hci_dev *hdev, bdaddr_t *bdaddr, u8 type)
{
        struct bdaddr_list *entry;

        if (bacmp(bdaddr, BDADDR_ANY) == 0)
                return -EBADF;

        if (hci_blacklist_lookup(hdev, bdaddr))
                return -EEXIST;

        entry = kzalloc(sizeof(struct bdaddr_list), GFP_KERNEL);
        if (!entry)
                return -ENOMEM;

        bacpy(&entry->bdaddr, bdaddr);

        list_add(&entry->list, &hdev->blacklist);

        return mgmt_device_blocked(hdev, bdaddr, type);
}

int hci_blacklist_del(struct hci_dev *hdev, bdaddr_t *bdaddr, u8 type)
{
        struct bdaddr_list *entry;

        if (bacmp(bdaddr, BDADDR_ANY) == 0)
                return hci_blacklist_clear(hdev);

        entry = hci_blacklist_lookup(hdev, bdaddr);
        if (!entry)
                return -ENOENT;

        list_del(&entry->list);
        kfree(entry);

        return mgmt_device_unblocked(hdev, bdaddr, type);
}

static void le_scan_param_req(struct hci_dev *hdev, unsigned long opt)
{
        struct le_scan_params *param =  (struct le_scan_params *) opt;
        struct hci_cp_le_set_scan_param cp;

        memset(&cp, 0, sizeof(cp));
        cp.type = param->type;
        cp.interval = cpu_to_le16(param->interval);
        cp.window = cpu_to_le16(param->window);

        hci_send_cmd(hdev, HCI_OP_LE_SET_SCAN_PARAM, sizeof(cp), &cp);
}

static void le_scan_enable_req(struct hci_dev *hdev, unsigned long opt)
{
        struct hci_cp_le_set_scan_enable cp;

        memset(&cp, 0, sizeof(cp));
        cp.enable = 1;
        cp.filter_dup = 1;

        hci_send_cmd(hdev, HCI_OP_LE_SET_SCAN_ENABLE, sizeof(cp), &cp);
}

static int hci_do_le_scan(struct hci_dev *hdev, u8 type, u16 interval,
                          u16 window, int timeout)
{
        long timeo = msecs_to_jiffies(3000);
        struct le_scan_params param;
        int err;

        BT_DBG("%s", hdev->name);

        if (test_bit(HCI_LE_SCAN, &hdev->dev_flags))
                return -EINPROGRESS;

        param.type = type;
        param.interval = interval;
        param.window = window;

        hci_req_lock(hdev);

        err = __hci_request(hdev, le_scan_param_req, (unsigned long) &param,
                            timeo);
        if (!err)
                err = __hci_request(hdev, le_scan_enable_req, 0, timeo);

        hci_req_unlock(hdev);

        if (err < 0)
                return err;

        schedule_delayed_work(&hdev->le_scan_disable,
                              msecs_to_jiffies(timeout));

        return 0;
}

int hci_cancel_le_scan(struct hci_dev *hdev)
{
        BT_DBG("%s", hdev->name);

        if (!test_bit(HCI_LE_SCAN, &hdev->dev_flags))
                return -EALREADY;

        if (cancel_delayed_work(&hdev->le_scan_disable)) {
                struct hci_cp_le_set_scan_enable cp;

                /* Send HCI command to disable LE Scan */
                memset(&cp, 0, sizeof(cp));
                hci_send_cmd(hdev, HCI_OP_LE_SET_SCAN_ENABLE, sizeof(cp), &cp);
        }

        return 0;
}

static void le_scan_disable_work(struct work_struct *work)
{
        struct hci_dev *hdev = container_of(work, struct hci_dev,
                                            le_scan_disable.work);
        struct hci_cp_le_set_scan_enable cp;

        BT_DBG("%s", hdev->name);

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

        hci_send_cmd(hdev, HCI_OP_LE_SET_SCAN_ENABLE, sizeof(cp), &cp);
}

static void le_scan_work(struct work_struct *work)
{
        struct hci_dev *hdev = container_of(work, struct hci_dev, le_scan);
        struct le_scan_params *param = &hdev->le_scan_params;

        BT_DBG("%s", hdev->name);

        hci_do_le_scan(hdev, param->type, param->interval, param->window,
                       param->timeout);
}

int hci_le_scan(struct hci_dev *hdev, u8 type, u16 interval, u16 window,
                int timeout)
{
        struct le_scan_params *param = &hdev->le_scan_params;

        BT_DBG("%s", hdev->name);

        if (test_bit(HCI_LE_PERIPHERAL, &hdev->dev_flags))
                return -ENOTSUPP;

        if (work_busy(&hdev->le_scan))
                return -EINPROGRESS;

        param->type = type;
        param->interval = interval;
        param->window = window;
        param->timeout = timeout;

        queue_work(system_long_wq, &hdev->le_scan);

        return 0;
}

/* Alloc HCI device */
struct hci_dev *hci_alloc_dev(void)
{
        struct hci_dev *hdev;

        hdev = kzalloc(sizeof(struct hci_dev), GFP_KERNEL);
        if (!hdev)
                return NULL;

        hdev->pkt_type  = (HCI_DM1 | HCI_DH1 | HCI_HV1);
        hdev->esco_type = (ESCO_HV1);
        hdev->link_mode = (HCI_LM_ACCEPT);
        hdev->io_capability = 0x03; /* No Input No Output */
        hdev->inq_tx_power = HCI_TX_POWER_INVALID;
        hdev->adv_tx_power = HCI_TX_POWER_INVALID;

        hdev->sniff_max_interval = 800;
        hdev->sniff_min_interval = 80;

        mutex_init(&hdev->lock);
        mutex_init(&hdev->req_lock);

        INIT_LIST_HEAD(&hdev->mgmt_pending);
        INIT_LIST_HEAD(&hdev->blacklist);
        INIT_LIST_HEAD(&hdev->uuids);
        INIT_LIST_HEAD(&hdev->link_keys);
        INIT_LIST_HEAD(&hdev->long_term_keys);
        INIT_LIST_HEAD(&hdev->remote_oob_data);
        INIT_LIST_HEAD(&hdev->conn_hash.list);

        INIT_WORK(&hdev->rx_work, hci_rx_work);
        INIT_WORK(&hdev->cmd_work, hci_cmd_work);
        INIT_WORK(&hdev->tx_work, hci_tx_work);
        INIT_WORK(&hdev->power_on, hci_power_on);
        INIT_WORK(&hdev->le_scan, le_scan_work);

        INIT_DELAYED_WORK(&hdev->power_off, hci_power_off);
        INIT_DELAYED_WORK(&hdev->discov_off, hci_discov_off);
        INIT_DELAYED_WORK(&hdev->le_scan_disable, le_scan_disable_work);

        skb_queue_head_init(&hdev->driver_init);
        skb_queue_head_init(&hdev->rx_q);
        skb_queue_head_init(&hdev->cmd_q);
        skb_queue_head_init(&hdev->raw_q);

        init_waitqueue_head(&hdev->req_wait_q);

        setup_timer(&hdev->cmd_timer, hci_cmd_timeout, (unsigned long) hdev);

        hci_init_sysfs(hdev);
        discovery_init(hdev);

        return hdev;
}
EXPORT_SYMBOL(hci_alloc_dev);

/* Free HCI device */
void hci_free_dev(struct hci_dev *hdev)
{
        skb_queue_purge(&hdev->driver_init);

        /* will free via device release */
        put_device(&hdev->dev);
}
EXPORT_SYMBOL(hci_free_dev);

/* Register HCI device */
int hci_register_dev(struct hci_dev *hdev)
{
        int id, error;

        if (!hdev->open || !hdev->close)
                return -EINVAL;

        /* Do not allow HCI_AMP devices to register at index 0,
         * so the index can be used as the AMP controller ID.
         */
        switch (hdev->dev_type) {
        case HCI_BREDR:
                id = ida_simple_get(&hci_index_ida, 0, 0, GFP_KERNEL);
                break;
        case HCI_AMP:
                id = ida_simple_get(&hci_index_ida, 1, 0, GFP_KERNEL);
                break;
        default:
                return -EINVAL;
        }

        if (id < 0)
                return id;

        sprintf(hdev->name, "hci%d", id);
        hdev->id = id;

        BT_DBG("%p name %s bus %d", hdev, hdev->name, hdev->bus);

        write_lock(&hci_dev_list_lock);
        list_add(&hdev->list, &hci_dev_list);
        write_unlock(&hci_dev_list_lock);

        hdev->workqueue = alloc_workqueue(hdev->name, WQ_HIGHPRI | WQ_UNBOUND |
                                          WQ_MEM_RECLAIM, 1);
        if (!hdev->workqueue) {
                error = -ENOMEM;
                goto err;
        }

        error = hci_add_sysfs(hdev);
        if (error < 0)
                goto err_wqueue;

        hdev->rfkill = rfkill_alloc(hdev->name, &hdev->dev,
                                    RFKILL_TYPE_BLUETOOTH, &hci_rfkill_ops,
                                    hdev);
        if (hdev->rfkill) {
                if (rfkill_register(hdev->rfkill) < 0) {
                        rfkill_destroy(hdev->rfkill);
                        hdev->rfkill = NULL;
                }
        }

        set_bit(HCI_SETUP, &hdev->dev_flags);

        if (hdev->dev_type != HCI_AMP)
                set_bit(HCI_AUTO_OFF, &hdev->dev_flags);

        hci_notify(hdev, HCI_DEV_REG);
        hci_dev_hold(hdev);

        schedule_work(&hdev->power_on);

        return id;

err_wqueue:
        destroy_workqueue(hdev->workqueue);
err:
        ida_simple_remove(&hci_index_ida, hdev->id);
        write_lock(&hci_dev_list_lock);
        list_del(&hdev->list);
        write_unlock(&hci_dev_list_lock);

        return error;
}
EXPORT_SYMBOL(hci_register_dev);

/* Unregister HCI device */
void hci_unregister_dev(struct hci_dev *hdev)
{
        int i, id;

        BT_DBG("%p name %s bus %d", hdev, hdev->name, hdev->bus);

        set_bit(HCI_UNREGISTER, &hdev->dev_flags);

        id = hdev->id;

        write_lock(&hci_dev_list_lock);
        list_del(&hdev->list);
        write_unlock(&hci_dev_list_lock);

        hci_dev_do_close(hdev);

        for (i = 0; i < NUM_REASSEMBLY; i++)
                kfree_skb(hdev->reassembly[i]);

        cancel_work_sync(&hdev->power_on);

        if (!test_bit(HCI_INIT, &hdev->flags) &&
            !test_bit(HCI_SETUP, &hdev->dev_flags)) {
                hci_dev_lock(hdev);
                mgmt_index_removed(hdev);
                hci_dev_unlock(hdev);
        }

        /* mgmt_index_removed should take care of emptying the
         * pending list */
        BUG_ON(!list_empty(&hdev->mgmt_pending));

        hci_notify(hdev, HCI_DEV_UNREG);

        if (hdev->rfkill) {
                rfkill_unregister(hdev->rfkill);
                rfkill_destroy(hdev->rfkill);
        }

        hci_del_sysfs(hdev);

        destroy_workqueue(hdev->workqueue);

        hci_dev_lock(hdev);
        hci_blacklist_clear(hdev);
        hci_uuids_clear(hdev);
        hci_link_keys_clear(hdev);
        hci_smp_ltks_clear(hdev);
        hci_remote_oob_data_clear(hdev);
        hci_dev_unlock(hdev);

        hci_dev_put(hdev);

        ida_simple_remove(&hci_index_ida, id);
}
EXPORT_SYMBOL(hci_unregister_dev);

/* Suspend HCI device */
int hci_suspend_dev(struct hci_dev *hdev)
{
        hci_notify(hdev, HCI_DEV_SUSPEND);
        return 0;
}
EXPORT_SYMBOL(hci_suspend_dev);

/* Resume HCI device */
int hci_resume_dev(struct hci_dev *hdev)
{
        hci_notify(hdev, HCI_DEV_RESUME);
        return 0;
}
EXPORT_SYMBOL(hci_resume_dev);

/* Receive frame from HCI drivers */
int hci_recv_frame(struct sk_buff *skb)
{
        struct hci_dev *hdev = (struct hci_dev *) skb->dev;
        if (!hdev || (!test_bit(HCI_UP, &hdev->flags)
                      && !test_bit(HCI_INIT, &hdev->flags))) {
                kfree_skb(skb);
                return -ENXIO;
        }

        /* Incomming skb */
        bt_cb(skb)->incoming = 1;

        /* Time stamp */
        __net_timestamp(skb);

        skb_queue_tail(&hdev->rx_q, skb);
        queue_work(hdev->workqueue, &hdev->rx_work);

        return 0;
}
EXPORT_SYMBOL(hci_recv_frame);

static int hci_reassembly(struct hci_dev *hdev, int type, void *data,
                          int count, __u8 index)
{
        int len = 0;
        int hlen = 0;
        int remain = count;
        struct sk_buff *skb;
        struct bt_skb_cb *scb;

        if ((type < HCI_ACLDATA_PKT || type > HCI_EVENT_PKT) ||
            index >= NUM_REASSEMBLY)
                return -EILSEQ;

        skb = hdev->reassembly[index];

        if (!skb) {
                switch (type) {
                case HCI_ACLDATA_PKT:
                        len = HCI_MAX_FRAME_SIZE;
                        hlen = HCI_ACL_HDR_SIZE;
                        break;
                case HCI_EVENT_PKT:
                        len = HCI_MAX_EVENT_SIZE;
                        hlen = HCI_EVENT_HDR_SIZE;
                        break;
                case HCI_SCODATA_PKT:
                        len = HCI_MAX_SCO_SIZE;
                        hlen = HCI_SCO_HDR_SIZE;
                        break;
                }

                skb = bt_skb_alloc(len, GFP_ATOMIC);
                if (!skb)
                        return -ENOMEM;

                scb = (void *) skb->cb;
                scb->expect = hlen;
                scb->pkt_type = type;

                skb->dev = (void *) hdev;
                hdev->reassembly[index] = skb;
        }

        while (count) {
                scb = (void *) skb->cb;
                len = min_t(uint, scb->expect, count);

                memcpy(skb_put(skb, len), data, len);

                count -= len;
                data += len;
                scb->expect -= len;
                remain = count;

                switch (type) {
                case HCI_EVENT_PKT:
                        if (skb->len == HCI_EVENT_HDR_SIZE) {
                                struct hci_event_hdr *h = hci_event_hdr(skb);
                                scb->expect = h->plen;

                                if (skb_tailroom(skb) < scb->expect) {
                                        kfree_skb(skb);
                                        hdev->reassembly[index] = NULL;
                                        return -ENOMEM;