forked from Minki/linux
8cf60cf238
Usually when driver sends data to firmware it receives TX_DONE (DN_LD_HOST_INT_STATUS) interrupt from firmware right away. It's also observed that some times the fireware could delay sending DN_LD_HOST_INT_STATUS interrupt. If driver sends data to firmware during suspend processing and the TX_DONE interrupt is delayed, it may come back at wrong time when SDIO host driver is in the middle of suspending. Block any data from stack while suspending. Also skip sending data that are already in driver tx_queue. Don't purge the skb queue on suspend to avoid intermittent music after system resumes from S3. Signed-off-by: Chin-Ran Lo <crlo@marvell.com> Signed-off-by: Amitkumar Karwar <akarwar@marvell.com> Signed-off-by: Marcel Holtmann <marcel@holtmann.org>
797 lines
18 KiB
C
797 lines
18 KiB
C
/**
|
|
* Marvell Bluetooth driver
|
|
*
|
|
* Copyright (C) 2009, Marvell International Ltd.
|
|
*
|
|
* This software file (the "File") is distributed by Marvell International
|
|
* Ltd. under the terms of the GNU General Public License Version 2, June 1991
|
|
* (the "License"). You may use, redistribute and/or modify this File in
|
|
* accordance with the terms and conditions of the License, a copy of which
|
|
* is available by writing to the Free Software Foundation, Inc.,
|
|
* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA or on the
|
|
* worldwide web at http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt.
|
|
*
|
|
*
|
|
* THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE
|
|
* IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE
|
|
* ARE EXPRESSLY DISCLAIMED. The License provides additional details about
|
|
* this warranty disclaimer.
|
|
**/
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/of.h>
|
|
#include <net/bluetooth/bluetooth.h>
|
|
#include <net/bluetooth/hci_core.h>
|
|
#include <linux/mmc/sdio_func.h>
|
|
|
|
#include "btmrvl_drv.h"
|
|
#include "btmrvl_sdio.h"
|
|
|
|
#define VERSION "1.0"
|
|
|
|
/*
|
|
* This function is called by interface specific interrupt handler.
|
|
* It updates Power Save & Host Sleep states, and wakes up the main
|
|
* thread.
|
|
*/
|
|
void btmrvl_interrupt(struct btmrvl_private *priv)
|
|
{
|
|
priv->adapter->ps_state = PS_AWAKE;
|
|
|
|
priv->adapter->wakeup_tries = 0;
|
|
|
|
priv->adapter->int_count++;
|
|
|
|
if (priv->adapter->hs_state == HS_ACTIVATED) {
|
|
BT_DBG("BT: HS DEACTIVATED in ISR!");
|
|
priv->adapter->hs_state = HS_DEACTIVATED;
|
|
}
|
|
|
|
wake_up_interruptible(&priv->main_thread.wait_q);
|
|
}
|
|
EXPORT_SYMBOL_GPL(btmrvl_interrupt);
|
|
|
|
bool btmrvl_check_evtpkt(struct btmrvl_private *priv, struct sk_buff *skb)
|
|
{
|
|
struct hci_event_hdr *hdr = (void *) skb->data;
|
|
|
|
if (hdr->evt == HCI_EV_CMD_COMPLETE) {
|
|
struct hci_ev_cmd_complete *ec;
|
|
u16 opcode;
|
|
|
|
ec = (void *) (skb->data + HCI_EVENT_HDR_SIZE);
|
|
opcode = __le16_to_cpu(ec->opcode);
|
|
|
|
if (priv->btmrvl_dev.sendcmdflag) {
|
|
priv->btmrvl_dev.sendcmdflag = false;
|
|
priv->adapter->cmd_complete = true;
|
|
wake_up_interruptible(&priv->adapter->cmd_wait_q);
|
|
|
|
if (hci_opcode_ogf(opcode) == 0x3F) {
|
|
BT_DBG("vendor event skipped: opcode=%#4.4x",
|
|
opcode);
|
|
kfree_skb(skb);
|
|
return false;
|
|
}
|
|
}
|
|
}
|
|
|
|
return true;
|
|
}
|
|
EXPORT_SYMBOL_GPL(btmrvl_check_evtpkt);
|
|
|
|
int btmrvl_process_event(struct btmrvl_private *priv, struct sk_buff *skb)
|
|
{
|
|
struct btmrvl_adapter *adapter = priv->adapter;
|
|
struct btmrvl_event *event;
|
|
int ret = 0;
|
|
|
|
event = (struct btmrvl_event *) skb->data;
|
|
if (event->ec != 0xff) {
|
|
BT_DBG("Not Marvell Event=%x", event->ec);
|
|
ret = -EINVAL;
|
|
goto exit;
|
|
}
|
|
|
|
switch (event->data[0]) {
|
|
case BT_EVENT_AUTO_SLEEP_MODE:
|
|
if (!event->data[2]) {
|
|
if (event->data[1] == BT_PS_ENABLE)
|
|
adapter->psmode = 1;
|
|
else
|
|
adapter->psmode = 0;
|
|
BT_DBG("PS Mode:%s",
|
|
(adapter->psmode) ? "Enable" : "Disable");
|
|
} else {
|
|
BT_DBG("PS Mode command failed");
|
|
}
|
|
break;
|
|
|
|
case BT_EVENT_HOST_SLEEP_CONFIG:
|
|
if (!event->data[3])
|
|
BT_DBG("gpio=%x, gap=%x", event->data[1],
|
|
event->data[2]);
|
|
else
|
|
BT_DBG("HSCFG command failed");
|
|
break;
|
|
|
|
case BT_EVENT_HOST_SLEEP_ENABLE:
|
|
if (!event->data[1]) {
|
|
adapter->hs_state = HS_ACTIVATED;
|
|
if (adapter->psmode)
|
|
adapter->ps_state = PS_SLEEP;
|
|
wake_up_interruptible(&adapter->event_hs_wait_q);
|
|
BT_DBG("HS ACTIVATED!");
|
|
} else {
|
|
BT_DBG("HS Enable failed");
|
|
}
|
|
break;
|
|
|
|
case BT_EVENT_MODULE_CFG_REQ:
|
|
if (priv->btmrvl_dev.sendcmdflag &&
|
|
event->data[1] == MODULE_BRINGUP_REQ) {
|
|
BT_DBG("EVENT:%s",
|
|
((event->data[2] == MODULE_BROUGHT_UP) ||
|
|
(event->data[2] == MODULE_ALREADY_UP)) ?
|
|
"Bring-up succeed" : "Bring-up failed");
|
|
|
|
if (event->length > 3 && event->data[3])
|
|
priv->btmrvl_dev.dev_type = HCI_AMP;
|
|
else
|
|
priv->btmrvl_dev.dev_type = HCI_BREDR;
|
|
|
|
BT_DBG("dev_type: %d", priv->btmrvl_dev.dev_type);
|
|
} else if (priv->btmrvl_dev.sendcmdflag &&
|
|
event->data[1] == MODULE_SHUTDOWN_REQ) {
|
|
BT_DBG("EVENT:%s", (event->data[2]) ?
|
|
"Shutdown failed" : "Shutdown succeed");
|
|
} else {
|
|
BT_DBG("BT_CMD_MODULE_CFG_REQ resp for APP");
|
|
ret = -EINVAL;
|
|
}
|
|
break;
|
|
|
|
case BT_EVENT_POWER_STATE:
|
|
if (event->data[1] == BT_PS_SLEEP)
|
|
adapter->ps_state = PS_SLEEP;
|
|
BT_DBG("EVENT:%s",
|
|
(adapter->ps_state) ? "PS_SLEEP" : "PS_AWAKE");
|
|
break;
|
|
|
|
default:
|
|
BT_DBG("Unknown Event=%d", event->data[0]);
|
|
ret = -EINVAL;
|
|
break;
|
|
}
|
|
|
|
exit:
|
|
if (!ret)
|
|
kfree_skb(skb);
|
|
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL_GPL(btmrvl_process_event);
|
|
|
|
static int btmrvl_send_sync_cmd(struct btmrvl_private *priv, u16 opcode,
|
|
const void *param, u8 len)
|
|
{
|
|
struct sk_buff *skb;
|
|
struct hci_command_hdr *hdr;
|
|
|
|
if (priv->surprise_removed) {
|
|
BT_ERR("Card is removed");
|
|
return -EFAULT;
|
|
}
|
|
|
|
skb = bt_skb_alloc(HCI_COMMAND_HDR_SIZE + len, GFP_ATOMIC);
|
|
if (!skb) {
|
|
BT_ERR("No free skb");
|
|
return -ENOMEM;
|
|
}
|
|
|
|
hdr = (struct hci_command_hdr *)skb_put(skb, HCI_COMMAND_HDR_SIZE);
|
|
hdr->opcode = cpu_to_le16(opcode);
|
|
hdr->plen = len;
|
|
|
|
if (len)
|
|
memcpy(skb_put(skb, len), param, len);
|
|
|
|
hci_skb_pkt_type(skb) = MRVL_VENDOR_PKT;
|
|
|
|
skb_queue_head(&priv->adapter->tx_queue, skb);
|
|
|
|
priv->btmrvl_dev.sendcmdflag = true;
|
|
|
|
priv->adapter->cmd_complete = false;
|
|
|
|
wake_up_interruptible(&priv->main_thread.wait_q);
|
|
|
|
if (!wait_event_interruptible_timeout(priv->adapter->cmd_wait_q,
|
|
priv->adapter->cmd_complete ||
|
|
priv->surprise_removed,
|
|
WAIT_UNTIL_CMD_RESP))
|
|
return -ETIMEDOUT;
|
|
|
|
if (priv->surprise_removed)
|
|
return -EFAULT;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int btmrvl_send_module_cfg_cmd(struct btmrvl_private *priv, u8 subcmd)
|
|
{
|
|
int ret;
|
|
|
|
ret = btmrvl_send_sync_cmd(priv, BT_CMD_MODULE_CFG_REQ, &subcmd, 1);
|
|
if (ret)
|
|
BT_ERR("module_cfg_cmd(%x) failed", subcmd);
|
|
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL_GPL(btmrvl_send_module_cfg_cmd);
|
|
|
|
static int btmrvl_enable_sco_routing_to_host(struct btmrvl_private *priv)
|
|
{
|
|
int ret;
|
|
u8 subcmd = 0;
|
|
|
|
ret = btmrvl_send_sync_cmd(priv, BT_CMD_ROUTE_SCO_TO_HOST, &subcmd, 1);
|
|
if (ret)
|
|
BT_ERR("BT_CMD_ROUTE_SCO_TO_HOST command failed: %#x", ret);
|
|
|
|
return ret;
|
|
}
|
|
|
|
int btmrvl_pscan_window_reporting(struct btmrvl_private *priv, u8 subcmd)
|
|
{
|
|
struct btmrvl_sdio_card *card = priv->btmrvl_dev.card;
|
|
int ret;
|
|
|
|
if (!card->support_pscan_win_report)
|
|
return 0;
|
|
|
|
ret = btmrvl_send_sync_cmd(priv, BT_CMD_PSCAN_WIN_REPORT_ENABLE,
|
|
&subcmd, 1);
|
|
if (ret)
|
|
BT_ERR("PSCAN_WIN_REPORT_ENABLE command failed: %#x", ret);
|
|
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL_GPL(btmrvl_pscan_window_reporting);
|
|
|
|
int btmrvl_send_hscfg_cmd(struct btmrvl_private *priv)
|
|
{
|
|
int ret;
|
|
u8 param[2];
|
|
|
|
param[0] = (priv->btmrvl_dev.gpio_gap & 0xff00) >> 8;
|
|
param[1] = (u8) (priv->btmrvl_dev.gpio_gap & 0x00ff);
|
|
|
|
BT_DBG("Sending HSCFG Command, gpio=0x%x, gap=0x%x",
|
|
param[0], param[1]);
|
|
|
|
ret = btmrvl_send_sync_cmd(priv, BT_CMD_HOST_SLEEP_CONFIG, param, 2);
|
|
if (ret)
|
|
BT_ERR("HSCFG command failed");
|
|
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL_GPL(btmrvl_send_hscfg_cmd);
|
|
|
|
int btmrvl_enable_ps(struct btmrvl_private *priv)
|
|
{
|
|
int ret;
|
|
u8 param;
|
|
|
|
if (priv->btmrvl_dev.psmode)
|
|
param = BT_PS_ENABLE;
|
|
else
|
|
param = BT_PS_DISABLE;
|
|
|
|
ret = btmrvl_send_sync_cmd(priv, BT_CMD_AUTO_SLEEP_MODE, ¶m, 1);
|
|
if (ret)
|
|
BT_ERR("PSMODE command failed");
|
|
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL_GPL(btmrvl_enable_ps);
|
|
|
|
int btmrvl_enable_hs(struct btmrvl_private *priv)
|
|
{
|
|
struct btmrvl_adapter *adapter = priv->adapter;
|
|
int ret;
|
|
|
|
ret = btmrvl_send_sync_cmd(priv, BT_CMD_HOST_SLEEP_ENABLE, NULL, 0);
|
|
if (ret) {
|
|
BT_ERR("Host sleep enable command failed");
|
|
return ret;
|
|
}
|
|
|
|
ret = wait_event_interruptible_timeout(adapter->event_hs_wait_q,
|
|
adapter->hs_state ||
|
|
priv->surprise_removed,
|
|
WAIT_UNTIL_HS_STATE_CHANGED);
|
|
if (ret < 0 || priv->surprise_removed) {
|
|
BT_ERR("event_hs_wait_q terminated (%d): %d,%d,%d",
|
|
ret, adapter->hs_state, adapter->ps_state,
|
|
adapter->wakeup_tries);
|
|
} else if (!ret) {
|
|
BT_ERR("hs_enable timeout: %d,%d,%d", adapter->hs_state,
|
|
adapter->ps_state, adapter->wakeup_tries);
|
|
ret = -ETIMEDOUT;
|
|
} else {
|
|
BT_DBG("host sleep enabled: %d,%d,%d", adapter->hs_state,
|
|
adapter->ps_state, adapter->wakeup_tries);
|
|
ret = 0;
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL_GPL(btmrvl_enable_hs);
|
|
|
|
int btmrvl_prepare_command(struct btmrvl_private *priv)
|
|
{
|
|
int ret = 0;
|
|
|
|
if (priv->btmrvl_dev.hscfgcmd) {
|
|
priv->btmrvl_dev.hscfgcmd = 0;
|
|
btmrvl_send_hscfg_cmd(priv);
|
|
}
|
|
|
|
if (priv->btmrvl_dev.pscmd) {
|
|
priv->btmrvl_dev.pscmd = 0;
|
|
btmrvl_enable_ps(priv);
|
|
}
|
|
|
|
if (priv->btmrvl_dev.hscmd) {
|
|
priv->btmrvl_dev.hscmd = 0;
|
|
|
|
if (priv->btmrvl_dev.hsmode) {
|
|
ret = btmrvl_enable_hs(priv);
|
|
} else {
|
|
ret = priv->hw_wakeup_firmware(priv);
|
|
priv->adapter->hs_state = HS_DEACTIVATED;
|
|
BT_DBG("BT: HS DEACTIVATED due to host activity!");
|
|
}
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
void btmrvl_firmware_dump(struct btmrvl_private *priv)
|
|
{
|
|
if (priv->firmware_dump)
|
|
priv->firmware_dump(priv);
|
|
}
|
|
|
|
static int btmrvl_tx_pkt(struct btmrvl_private *priv, struct sk_buff *skb)
|
|
{
|
|
int ret = 0;
|
|
|
|
if (!skb || !skb->data)
|
|
return -EINVAL;
|
|
|
|
if (!skb->len || ((skb->len + BTM_HEADER_LEN) > BTM_UPLD_SIZE)) {
|
|
BT_ERR("Tx Error: Bad skb length %d : %d",
|
|
skb->len, BTM_UPLD_SIZE);
|
|
return -EINVAL;
|
|
}
|
|
|
|
skb_push(skb, BTM_HEADER_LEN);
|
|
|
|
/* header type: byte[3]
|
|
* HCI_COMMAND = 1, ACL_DATA = 2, SCO_DATA = 3, 0xFE = Vendor
|
|
* header length: byte[2][1][0]
|
|
*/
|
|
|
|
skb->data[0] = (skb->len & 0x0000ff);
|
|
skb->data[1] = (skb->len & 0x00ff00) >> 8;
|
|
skb->data[2] = (skb->len & 0xff0000) >> 16;
|
|
skb->data[3] = hci_skb_pkt_type(skb);
|
|
|
|
if (priv->hw_host_to_card)
|
|
ret = priv->hw_host_to_card(priv, skb->data, skb->len);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static void btmrvl_init_adapter(struct btmrvl_private *priv)
|
|
{
|
|
int buf_size;
|
|
|
|
skb_queue_head_init(&priv->adapter->tx_queue);
|
|
|
|
priv->adapter->ps_state = PS_AWAKE;
|
|
|
|
buf_size = ALIGN_SZ(SDIO_BLOCK_SIZE, BTSDIO_DMA_ALIGN);
|
|
priv->adapter->hw_regs_buf = kzalloc(buf_size, GFP_KERNEL);
|
|
if (!priv->adapter->hw_regs_buf) {
|
|
priv->adapter->hw_regs = NULL;
|
|
BT_ERR("Unable to allocate buffer for hw_regs.");
|
|
} else {
|
|
priv->adapter->hw_regs =
|
|
(u8 *)ALIGN_ADDR(priv->adapter->hw_regs_buf,
|
|
BTSDIO_DMA_ALIGN);
|
|
BT_DBG("hw_regs_buf=%p hw_regs=%p",
|
|
priv->adapter->hw_regs_buf, priv->adapter->hw_regs);
|
|
}
|
|
|
|
init_waitqueue_head(&priv->adapter->cmd_wait_q);
|
|
init_waitqueue_head(&priv->adapter->event_hs_wait_q);
|
|
}
|
|
|
|
static void btmrvl_free_adapter(struct btmrvl_private *priv)
|
|
{
|
|
skb_queue_purge(&priv->adapter->tx_queue);
|
|
|
|
kfree(priv->adapter->hw_regs_buf);
|
|
kfree(priv->adapter);
|
|
|
|
priv->adapter = NULL;
|
|
}
|
|
|
|
static int btmrvl_send_frame(struct hci_dev *hdev, struct sk_buff *skb)
|
|
{
|
|
struct btmrvl_private *priv = hci_get_drvdata(hdev);
|
|
|
|
BT_DBG("type=%d, len=%d", hci_skb_pkt_type(skb), skb->len);
|
|
|
|
if (priv->adapter->is_suspending || priv->adapter->is_suspended) {
|
|
BT_ERR("%s: Device is suspending or suspended", __func__);
|
|
return -EBUSY;
|
|
}
|
|
|
|
switch (hci_skb_pkt_type(skb)) {
|
|
case HCI_COMMAND_PKT:
|
|
hdev->stat.cmd_tx++;
|
|
break;
|
|
|
|
case HCI_ACLDATA_PKT:
|
|
hdev->stat.acl_tx++;
|
|
break;
|
|
|
|
case HCI_SCODATA_PKT:
|
|
hdev->stat.sco_tx++;
|
|
break;
|
|
}
|
|
|
|
skb_queue_tail(&priv->adapter->tx_queue, skb);
|
|
|
|
if (!priv->adapter->is_suspended)
|
|
wake_up_interruptible(&priv->main_thread.wait_q);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int btmrvl_flush(struct hci_dev *hdev)
|
|
{
|
|
struct btmrvl_private *priv = hci_get_drvdata(hdev);
|
|
|
|
skb_queue_purge(&priv->adapter->tx_queue);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int btmrvl_close(struct hci_dev *hdev)
|
|
{
|
|
struct btmrvl_private *priv = hci_get_drvdata(hdev);
|
|
|
|
skb_queue_purge(&priv->adapter->tx_queue);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int btmrvl_open(struct hci_dev *hdev)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
static int btmrvl_download_cal_data(struct btmrvl_private *priv,
|
|
u8 *data, int len)
|
|
{
|
|
int ret;
|
|
|
|
data[0] = 0x00;
|
|
data[1] = 0x00;
|
|
data[2] = 0x00;
|
|
data[3] = len;
|
|
|
|
print_hex_dump_bytes("Calibration data: ",
|
|
DUMP_PREFIX_OFFSET, data, BT_CAL_HDR_LEN + len);
|
|
|
|
ret = btmrvl_send_sync_cmd(priv, BT_CMD_LOAD_CONFIG_DATA, data,
|
|
BT_CAL_HDR_LEN + len);
|
|
if (ret)
|
|
BT_ERR("Failed to download caibration data");
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int btmrvl_check_device_tree(struct btmrvl_private *priv)
|
|
{
|
|
struct device_node *dt_node;
|
|
u8 cal_data[BT_CAL_HDR_LEN + BT_CAL_DATA_SIZE];
|
|
int ret;
|
|
u32 val;
|
|
|
|
for_each_compatible_node(dt_node, NULL, "btmrvl,cfgdata") {
|
|
ret = of_property_read_u32(dt_node, "btmrvl,gpio-gap", &val);
|
|
if (!ret)
|
|
priv->btmrvl_dev.gpio_gap = val;
|
|
|
|
ret = of_property_read_u8_array(dt_node, "btmrvl,cal-data",
|
|
cal_data + BT_CAL_HDR_LEN,
|
|
BT_CAL_DATA_SIZE);
|
|
if (ret) {
|
|
of_node_put(dt_node);
|
|
return ret;
|
|
}
|
|
|
|
BT_DBG("Use cal data from device tree");
|
|
ret = btmrvl_download_cal_data(priv, cal_data,
|
|
BT_CAL_DATA_SIZE);
|
|
if (ret) {
|
|
BT_ERR("Fail to download calibrate data");
|
|
of_node_put(dt_node);
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int btmrvl_setup(struct hci_dev *hdev)
|
|
{
|
|
struct btmrvl_private *priv = hci_get_drvdata(hdev);
|
|
int ret;
|
|
|
|
ret = btmrvl_send_module_cfg_cmd(priv, MODULE_BRINGUP_REQ);
|
|
if (ret)
|
|
return ret;
|
|
|
|
priv->btmrvl_dev.gpio_gap = 0xfffe;
|
|
|
|
btmrvl_check_device_tree(priv);
|
|
|
|
btmrvl_enable_sco_routing_to_host(priv);
|
|
|
|
btmrvl_pscan_window_reporting(priv, 0x01);
|
|
|
|
priv->btmrvl_dev.psmode = 1;
|
|
btmrvl_enable_ps(priv);
|
|
|
|
btmrvl_send_hscfg_cmd(priv);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int btmrvl_set_bdaddr(struct hci_dev *hdev, const bdaddr_t *bdaddr)
|
|
{
|
|
struct sk_buff *skb;
|
|
long ret;
|
|
u8 buf[8];
|
|
|
|
buf[0] = MRVL_VENDOR_PKT;
|
|
buf[1] = sizeof(bdaddr_t);
|
|
memcpy(buf + 2, bdaddr, sizeof(bdaddr_t));
|
|
|
|
skb = __hci_cmd_sync(hdev, BT_CMD_SET_BDADDR, sizeof(buf), buf,
|
|
HCI_INIT_TIMEOUT);
|
|
if (IS_ERR(skb)) {
|
|
ret = PTR_ERR(skb);
|
|
BT_ERR("%s: changing btmrvl device address failed (%ld)",
|
|
hdev->name, ret);
|
|
return ret;
|
|
}
|
|
kfree_skb(skb);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* This function handles the event generated by firmware, rx data
|
|
* received from firmware, and tx data sent from kernel.
|
|
*/
|
|
static int btmrvl_service_main_thread(void *data)
|
|
{
|
|
struct btmrvl_thread *thread = data;
|
|
struct btmrvl_private *priv = thread->priv;
|
|
struct btmrvl_adapter *adapter = priv->adapter;
|
|
wait_queue_t wait;
|
|
struct sk_buff *skb;
|
|
ulong flags;
|
|
|
|
init_waitqueue_entry(&wait, current);
|
|
|
|
for (;;) {
|
|
add_wait_queue(&thread->wait_q, &wait);
|
|
|
|
set_current_state(TASK_INTERRUPTIBLE);
|
|
if (kthread_should_stop() || priv->surprise_removed) {
|
|
BT_DBG("main_thread: break from main thread");
|
|
break;
|
|
}
|
|
|
|
if (adapter->wakeup_tries ||
|
|
((!adapter->int_count) &&
|
|
(!priv->btmrvl_dev.tx_dnld_rdy ||
|
|
skb_queue_empty(&adapter->tx_queue)))) {
|
|
BT_DBG("main_thread is sleeping...");
|
|
schedule();
|
|
}
|
|
|
|
set_current_state(TASK_RUNNING);
|
|
|
|
remove_wait_queue(&thread->wait_q, &wait);
|
|
|
|
BT_DBG("main_thread woke up");
|
|
|
|
if (kthread_should_stop() || priv->surprise_removed) {
|
|
BT_DBG("main_thread: break from main thread");
|
|
break;
|
|
}
|
|
|
|
spin_lock_irqsave(&priv->driver_lock, flags);
|
|
if (adapter->int_count) {
|
|
adapter->int_count = 0;
|
|
spin_unlock_irqrestore(&priv->driver_lock, flags);
|
|
priv->hw_process_int_status(priv);
|
|
} else if (adapter->ps_state == PS_SLEEP &&
|
|
!skb_queue_empty(&adapter->tx_queue)) {
|
|
spin_unlock_irqrestore(&priv->driver_lock, flags);
|
|
adapter->wakeup_tries++;
|
|
priv->hw_wakeup_firmware(priv);
|
|
continue;
|
|
} else {
|
|
spin_unlock_irqrestore(&priv->driver_lock, flags);
|
|
}
|
|
|
|
if (adapter->ps_state == PS_SLEEP)
|
|
continue;
|
|
|
|
if (!priv->btmrvl_dev.tx_dnld_rdy ||
|
|
priv->adapter->is_suspended)
|
|
continue;
|
|
|
|
skb = skb_dequeue(&adapter->tx_queue);
|
|
if (skb) {
|
|
if (btmrvl_tx_pkt(priv, skb))
|
|
priv->btmrvl_dev.hcidev->stat.err_tx++;
|
|
else
|
|
priv->btmrvl_dev.hcidev->stat.byte_tx += skb->len;
|
|
|
|
kfree_skb(skb);
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int btmrvl_register_hdev(struct btmrvl_private *priv)
|
|
{
|
|
struct hci_dev *hdev = NULL;
|
|
int ret;
|
|
|
|
hdev = hci_alloc_dev();
|
|
if (!hdev) {
|
|
BT_ERR("Can not allocate HCI device");
|
|
goto err_hdev;
|
|
}
|
|
|
|
priv->btmrvl_dev.hcidev = hdev;
|
|
hci_set_drvdata(hdev, priv);
|
|
|
|
hdev->bus = HCI_SDIO;
|
|
hdev->open = btmrvl_open;
|
|
hdev->close = btmrvl_close;
|
|
hdev->flush = btmrvl_flush;
|
|
hdev->send = btmrvl_send_frame;
|
|
hdev->setup = btmrvl_setup;
|
|
hdev->set_bdaddr = btmrvl_set_bdaddr;
|
|
|
|
hdev->dev_type = priv->btmrvl_dev.dev_type;
|
|
|
|
ret = hci_register_dev(hdev);
|
|
if (ret < 0) {
|
|
BT_ERR("Can not register HCI device");
|
|
goto err_hci_register_dev;
|
|
}
|
|
|
|
#ifdef CONFIG_DEBUG_FS
|
|
btmrvl_debugfs_init(hdev);
|
|
#endif
|
|
|
|
return 0;
|
|
|
|
err_hci_register_dev:
|
|
hci_free_dev(hdev);
|
|
|
|
err_hdev:
|
|
/* Stop the thread servicing the interrupts */
|
|
kthread_stop(priv->main_thread.task);
|
|
|
|
btmrvl_free_adapter(priv);
|
|
kfree(priv);
|
|
|
|
return -ENOMEM;
|
|
}
|
|
EXPORT_SYMBOL_GPL(btmrvl_register_hdev);
|
|
|
|
struct btmrvl_private *btmrvl_add_card(void *card)
|
|
{
|
|
struct btmrvl_private *priv;
|
|
|
|
priv = kzalloc(sizeof(*priv), GFP_KERNEL);
|
|
if (!priv) {
|
|
BT_ERR("Can not allocate priv");
|
|
goto err_priv;
|
|
}
|
|
|
|
priv->adapter = kzalloc(sizeof(*priv->adapter), GFP_KERNEL);
|
|
if (!priv->adapter) {
|
|
BT_ERR("Allocate buffer for btmrvl_adapter failed!");
|
|
goto err_adapter;
|
|
}
|
|
|
|
btmrvl_init_adapter(priv);
|
|
|
|
BT_DBG("Starting kthread...");
|
|
priv->main_thread.priv = priv;
|
|
spin_lock_init(&priv->driver_lock);
|
|
|
|
init_waitqueue_head(&priv->main_thread.wait_q);
|
|
priv->main_thread.task = kthread_run(btmrvl_service_main_thread,
|
|
&priv->main_thread, "btmrvl_main_service");
|
|
if (IS_ERR(priv->main_thread.task))
|
|
goto err_thread;
|
|
|
|
priv->btmrvl_dev.card = card;
|
|
priv->btmrvl_dev.tx_dnld_rdy = true;
|
|
|
|
return priv;
|
|
|
|
err_thread:
|
|
btmrvl_free_adapter(priv);
|
|
|
|
err_adapter:
|
|
kfree(priv);
|
|
|
|
err_priv:
|
|
return NULL;
|
|
}
|
|
EXPORT_SYMBOL_GPL(btmrvl_add_card);
|
|
|
|
int btmrvl_remove_card(struct btmrvl_private *priv)
|
|
{
|
|
struct hci_dev *hdev;
|
|
|
|
hdev = priv->btmrvl_dev.hcidev;
|
|
|
|
wake_up_interruptible(&priv->adapter->cmd_wait_q);
|
|
wake_up_interruptible(&priv->adapter->event_hs_wait_q);
|
|
|
|
kthread_stop(priv->main_thread.task);
|
|
|
|
#ifdef CONFIG_DEBUG_FS
|
|
btmrvl_debugfs_remove(hdev);
|
|
#endif
|
|
|
|
hci_unregister_dev(hdev);
|
|
|
|
hci_free_dev(hdev);
|
|
|
|
priv->btmrvl_dev.hcidev = NULL;
|
|
|
|
btmrvl_free_adapter(priv);
|
|
|
|
kfree(priv);
|
|
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL_GPL(btmrvl_remove_card);
|
|
|
|
MODULE_AUTHOR("Marvell International Ltd.");
|
|
MODULE_DESCRIPTION("Marvell Bluetooth driver ver " VERSION);
|
|
MODULE_VERSION(VERSION);
|
|
MODULE_LICENSE("GPL v2");
|