btmrvl_main.c 17.6 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20
/**
 * 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.
 **/

21
#include <linux/module.h>
22
#include <linux/of.h>
23 24
#include <net/bluetooth/bluetooth.h>
#include <net/bluetooth/hci_core.h>
25
#include <linux/mmc/sdio_func.h>
26 27

#include "btmrvl_drv.h"
28
#include "btmrvl_sdio.h"
29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44

#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++;

45
	if (priv->adapter->hs_state == HS_ACTIVATED) {
46
		BT_DBG("BT: HS DEACTIVATED in ISR!");
47 48 49
		priv->adapter->hs_state = HS_DEACTIVATED;
	}

50 51 52 53
	wake_up_interruptible(&priv->main_thread.wait_q);
}
EXPORT_SYMBOL_GPL(btmrvl_interrupt);

54
bool btmrvl_check_evtpkt(struct btmrvl_private *priv, struct sk_buff *skb)
55
{
56
	struct hci_event_hdr *hdr = (void *) skb->data;
57 58

	if (hdr->evt == HCI_EV_CMD_COMPLETE) {
59
		struct hci_ev_cmd_complete *ec;
60
		u16 opcode;
61

62
		ec = (void *) (skb->data + HCI_EVENT_HDR_SIZE);
63
		opcode = __le16_to_cpu(ec->opcode);
64

65
		if (priv->btmrvl_dev.sendcmdflag) {
66 67 68
			priv->btmrvl_dev.sendcmdflag = false;
			priv->adapter->cmd_complete = true;
			wake_up_interruptible(&priv->adapter->cmd_wait_q);
69

70 71 72 73 74 75
			if (hci_opcode_ogf(opcode) == 0x3F) {
				BT_DBG("vendor event skipped: opcode=%#4.4x",
				       opcode);
				kfree_skb(skb);
				return false;
			}
76
		}
77
	}
78 79

	return true;
80 81 82 83 84 85 86
}
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;
87
	int ret = 0;
88 89 90 91 92 93 94 95 96

	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]) {
97
	case BT_EVENT_AUTO_SLEEP_MODE:
98 99 100 101 102 103 104 105 106 107 108 109
		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;

110
	case BT_EVENT_HOST_SLEEP_CONFIG:
111 112
		if (!event->data[3])
			BT_DBG("gpio=%x, gap=%x", event->data[1],
113
							event->data[2]);
114 115 116 117
		else
			BT_DBG("HSCFG command failed");
		break;

118
	case BT_EVENT_HOST_SLEEP_ENABLE:
119 120 121 122
		if (!event->data[1]) {
			adapter->hs_state = HS_ACTIVATED;
			if (adapter->psmode)
				adapter->ps_state = PS_SLEEP;
123
			wake_up_interruptible(&adapter->event_hs_wait_q);
124 125 126 127 128 129
			BT_DBG("HS ACTIVATED!");
		} else {
			BT_DBG("HS Enable failed");
		}
		break;

130
	case BT_EVENT_MODULE_CFG_REQ:
131 132
		if (priv->btmrvl_dev.sendcmdflag &&
				event->data[1] == MODULE_BRINGUP_REQ) {
133 134 135 136
			BT_DBG("EVENT:%s",
				((event->data[2] == MODULE_BROUGHT_UP) ||
				(event->data[2] == MODULE_ALREADY_UP)) ?
				"Bring-up succeed" : "Bring-up failed");
137

138 139
			if (event->length > 3 && event->data[3])
				priv->btmrvl_dev.dev_type = HCI_AMP;
140 141 142 143
			else
				priv->btmrvl_dev.dev_type = HCI_BREDR;

			BT_DBG("dev_type: %d", priv->btmrvl_dev.dev_type);
144 145
		} else if (priv->btmrvl_dev.sendcmdflag &&
				event->data[1] == MODULE_SHUTDOWN_REQ) {
146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174
			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);

175
static int btmrvl_send_sync_cmd(struct btmrvl_private *priv, u16 opcode,
176
				const void *param, u8 len)
177
{
178
	struct sk_buff *skb;
179
	struct hci_command_hdr *hdr;
180

181
	skb = bt_skb_alloc(HCI_COMMAND_HDR_SIZE + len, GFP_ATOMIC);
182 183
	if (skb == NULL) {
		BT_ERR("No free skb");
184
		return -ENOMEM;
185 186
	}

187
	hdr = (struct hci_command_hdr *)skb_put(skb, HCI_COMMAND_HDR_SIZE);
188
	hdr->opcode = cpu_to_le16(opcode);
189
	hdr->plen = len;
190 191

	if (len)
192
		memcpy(skb_put(skb, len), param, len);
193 194 195 196 197 198 199 200 201 202 203

	bt_cb(skb)->pkt_type = 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);

204 205
	if (!wait_event_interruptible_timeout(priv->adapter->cmd_wait_q,
				priv->adapter->cmd_complete,
206 207 208 209 210
				msecs_to_jiffies(WAIT_UNTIL_CMD_RESP)))
		return -ETIMEDOUT;

	return 0;
}
211

212
int btmrvl_send_module_cfg_cmd(struct btmrvl_private *priv, u8 subcmd)
213 214 215 216 217
{
	int ret;

	ret = btmrvl_send_sync_cmd(priv, BT_CMD_MODULE_CFG_REQ, &subcmd, 1);
	if (ret)
218
		BT_ERR("module_cfg_cmd(%x) failed", subcmd);
219 220 221 222 223

	return ret;
}
EXPORT_SYMBOL_GPL(btmrvl_send_module_cfg_cmd);

224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240
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);

241 242
int btmrvl_send_hscfg_cmd(struct btmrvl_private *priv)
{
243 244
	int ret;
	u8 param[2];
245

246 247
	param[0] = (priv->btmrvl_dev.gpio_gap & 0xff00) >> 8;
	param[1] = (u8) (priv->btmrvl_dev.gpio_gap & 0x00ff);
248

249 250
	BT_DBG("Sending HSCFG Command, gpio=0x%x, gap=0x%x",
	       param[0], param[1]);
251

252 253
	ret = btmrvl_send_sync_cmd(priv, BT_CMD_HOST_SLEEP_CONFIG, param, 2);
	if (ret)
254
		BT_ERR("HSCFG command failed");
255

256
	return ret;
257 258 259
}
EXPORT_SYMBOL_GPL(btmrvl_send_hscfg_cmd);

260 261
int btmrvl_enable_ps(struct btmrvl_private *priv)
{
262 263
	int ret;
	u8 param;
264 265

	if (priv->btmrvl_dev.psmode)
266
		param = BT_PS_ENABLE;
267
	else
268
		param = BT_PS_DISABLE;
269

270 271
	ret = btmrvl_send_sync_cmd(priv, BT_CMD_AUTO_SLEEP_MODE, &param, 1);
	if (ret)
272
		BT_ERR("PSMODE command failed");
273 274 275 276 277

	return 0;
}
EXPORT_SYMBOL_GPL(btmrvl_enable_ps);

278
int btmrvl_enable_hs(struct btmrvl_private *priv)
279
{
280
	struct btmrvl_adapter *adapter = priv->adapter;
281
	int ret;
282

283
	ret = btmrvl_send_sync_cmd(priv, BT_CMD_HOST_SLEEP_ENABLE, NULL, 0);
284
	if (ret) {
285
		BT_ERR("Host sleep enable command failed");
286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304
		return ret;
	}

	ret = wait_event_interruptible_timeout(adapter->event_hs_wait_q,
					       adapter->hs_state,
			msecs_to_jiffies(WAIT_UNTIL_HS_STATE_CHANGED));
	if (ret < 0) {
		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;
	}
305 306 307

	return ret;
}
308
EXPORT_SYMBOL_GPL(btmrvl_enable_hs);
309 310 311

int btmrvl_prepare_command(struct btmrvl_private *priv)
{
312
	int ret = 0;
313 314 315

	if (priv->btmrvl_dev.hscfgcmd) {
		priv->btmrvl_dev.hscfgcmd = 0;
316
		btmrvl_send_hscfg_cmd(priv);
317 318 319 320
	}

	if (priv->btmrvl_dev.pscmd) {
		priv->btmrvl_dev.pscmd = 0;
321
		btmrvl_enable_ps(priv);
322 323 324 325 326 327 328 329 330 331
	}

	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;
332
			BT_DBG("BT: HS DEACTIVATED due to host activity!");
333 334 335 336 337 338
		}
	}

	return ret;
}

339 340 341 342 343 344
void btmrvl_firmware_dump(struct btmrvl_private *priv)
{
	if (priv->firmware_dump)
		priv->firmware_dump(priv);
}

345 346
static int btmrvl_tx_pkt(struct btmrvl_private *priv, struct sk_buff *skb)
{
347
	int ret = 0;
348

349
	if (!skb || !skb->data)
350 351 352 353
		return -EINVAL;

	if (!skb->len || ((skb->len + BTM_HEADER_LEN) > BTM_UPLD_SIZE)) {
		BT_ERR("Tx Error: Bad skb length %d : %d",
354
						skb->len, BTM_UPLD_SIZE);
355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391
		return -EINVAL;
	}

	if (skb_headroom(skb) < BTM_HEADER_LEN) {
		struct sk_buff *tmp = skb;

		skb = skb_realloc_headroom(skb, BTM_HEADER_LEN);
		if (!skb) {
			BT_ERR("Tx Error: realloc_headroom failed %d",
				BTM_HEADER_LEN);
			skb = tmp;
			return -EINVAL;
		}

		kfree_skb(tmp);
	}

	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] = bt_cb(skb)->pkt_type;

	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)
{
392 393
	int buf_size;

394 395 396 397
	skb_queue_head_init(&priv->adapter->tx_queue);

	priv->adapter->ps_state = PS_AWAKE;

398 399 400 401 402 403 404 405 406 407 408 409 410
	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);
	}

411
	init_waitqueue_head(&priv->adapter->cmd_wait_q);
412
	init_waitqueue_head(&priv->adapter->event_hs_wait_q);
413 414 415 416 417 418
}

static void btmrvl_free_adapter(struct btmrvl_private *priv)
{
	skb_queue_purge(&priv->adapter->tx_queue);

419
	kfree(priv->adapter->hw_regs_buf);
420 421 422 423 424
	kfree(priv->adapter);

	priv->adapter = NULL;
}

425
static int btmrvl_send_frame(struct hci_dev *hdev, struct sk_buff *skb)
426
{
427
	struct btmrvl_private *priv = hci_get_drvdata(hdev);
428

429
	BT_DBG("type=%d, len=%d", skb->pkt_type, skb->len);
430 431 432 433

	if (!test_bit(HCI_RUNNING, &hdev->flags)) {
		BT_ERR("Failed testing HCI_RUNING, flags=%lx", hdev->flags);
		print_hex_dump_bytes("data: ", DUMP_PREFIX_OFFSET,
434
							skb->data, skb->len);
435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460
		return -EBUSY;
	}

	switch (bt_cb(skb)->pkt_type) {
	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);

	wake_up_interruptible(&priv->main_thread.wait_q);

	return 0;
}

static int btmrvl_flush(struct hci_dev *hdev)
{
461
	struct btmrvl_private *priv = hci_get_drvdata(hdev);
462 463 464 465 466 467 468 469

	skb_queue_purge(&priv->adapter->tx_queue);

	return 0;
}

static int btmrvl_close(struct hci_dev *hdev)
{
470
	struct btmrvl_private *priv = hci_get_drvdata(hdev);
471

472
	if (!test_and_clear_bit(HCI_RUNNING, &hdev->flags))
473 474 475 476 477 478 479 480 481 482 483 484 485 486
		return 0;

	skb_queue_purge(&priv->adapter->tx_queue);

	return 0;
}

static int btmrvl_open(struct hci_dev *hdev)
{
	set_bit(HCI_RUNNING, &hdev->flags);

	return 0;
}

487
static int btmrvl_download_cal_data(struct btmrvl_private *priv,
488
				    u8 *data, int len)
489
{
490
	int ret;
491 492 493 494

	data[0] = 0x00;
	data[1] = 0x00;
	data[2] = 0x00;
495
	data[3] = len;
496 497

	print_hex_dump_bytes("Calibration data: ",
498
			     DUMP_PREFIX_OFFSET, data, BT_CAL_HDR_LEN + len);
499 500

	ret = btmrvl_send_sync_cmd(priv, BT_CMD_LOAD_CONFIG_DATA, data,
501
				   BT_CAL_HDR_LEN + len);
502
	if (ret)
503
		BT_ERR("Failed to download caibration data");
504 505 506 507

	return 0;
}

508
static int btmrvl_check_device_tree(struct btmrvl_private *priv)
509
{
510
	struct device_node *dt_node;
511
	u8 cal_data[BT_CAL_HDR_LEN + BT_CAL_DATA_SIZE];
512
	int ret;
513
	u32 val;
514

515
	for_each_compatible_node(dt_node, NULL, "btmrvl,cfgdata") {
516 517 518 519
		ret = of_property_read_u32(dt_node, "btmrvl,gpio-gap", &val);
		if (!ret)
			priv->btmrvl_dev.gpio_gap = val;

520 521 522 523 524 525 526 527 528 529 530 531 532
		ret = of_property_read_u8_array(dt_node, "btmrvl,cal-data",
						cal_data + BT_CAL_HDR_LEN,
						BT_CAL_DATA_SIZE);
		if (ret)
			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");
			return ret;
		}
533 534 535 536 537
	}

	return 0;
}

538 539 540 541 542 543
static int btmrvl_setup(struct hci_dev *hdev)
{
	struct btmrvl_private *priv = hci_get_drvdata(hdev);

	btmrvl_send_module_cfg_cmd(priv, MODULE_BRINGUP_REQ);

544 545 546
	priv->btmrvl_dev.gpio_gap = 0xffff;

	btmrvl_check_device_tree(priv);
547

548 549
	btmrvl_pscan_window_reporting(priv, 0x01);

550 551 552 553 554 555 556 557
	priv->btmrvl_dev.psmode = 1;
	btmrvl_enable_ps(priv);

	btmrvl_send_hscfg_cmd(priv);

	return 0;
}

558 559 560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580
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;
}

581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599
/*
 * 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);
600 601 602 603
		if (kthread_should_stop()) {
			BT_DBG("main_thread: break from main thread");
			break;
		}
604 605

		if (adapter->wakeup_tries ||
606 607 608
				((!adapter->int_count) &&
				(!priv->btmrvl_dev.tx_dnld_rdy ||
				skb_queue_empty(&adapter->tx_queue)))) {
609 610 611 612 613 614 615 616 617 618
			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");

619 620 621 622 623
		if (kthread_should_stop()) {
			BT_DBG("main_thread: break from main thread");
			break;
		}

624 625 626
		spin_lock_irqsave(&priv->driver_lock, flags);
		if (adapter->int_count) {
			adapter->int_count = 0;
627 628
			spin_unlock_irqrestore(&priv->driver_lock, flags);
			priv->hw_process_int_status(priv);
629 630
		} else if (adapter->ps_state == PS_SLEEP &&
					!skb_queue_empty(&adapter->tx_queue)) {
631 632 633 634
			spin_unlock_irqrestore(&priv->driver_lock, flags);
			adapter->wakeup_tries++;
			priv->hw_wakeup_firmware(priv);
			continue;
635 636
		} else {
			spin_unlock_irqrestore(&priv->driver_lock, flags);
637 638 639 640 641 642 643 644 645 646 647 648 649
		}

		if (adapter->ps_state == PS_SLEEP)
			continue;

		if (!priv->btmrvl_dev.tx_dnld_rdy)
			continue;

		skb = skb_dequeue(&adapter->tx_queue);
		if (skb) {
			if (btmrvl_tx_pkt(priv, skb))
				priv->btmrvl_dev.hcidev->stat.err_tx++;
			else
650
				priv->btmrvl_dev.hcidev->stat.byte_tx += skb->len;
651 652 653 654 655 656 657 658

			kfree_skb(skb);
		}
	}

	return 0;
}

659
int btmrvl_register_hdev(struct btmrvl_private *priv)
660 661 662 663 664 665 666 667 668 669 670
{
	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;
671
	hci_set_drvdata(hdev, priv);
672

673 674
	hdev->bus   = HCI_SDIO;
	hdev->open  = btmrvl_open;
675 676
	hdev->close = btmrvl_close;
	hdev->flush = btmrvl_flush;
677
	hdev->send  = btmrvl_send_frame;
678
	hdev->setup = btmrvl_setup;
679
	hdev->set_bdaddr = btmrvl_set_bdaddr;
680

681 682
	hdev->dev_type = priv->btmrvl_dev.dev_type;

683 684 685 686 687 688
	ret = hci_register_dev(hdev);
	if (ret < 0) {
		BT_ERR("Can not register HCI device");
		goto err_hci_register_dev;
	}

689 690 691 692
#ifdef CONFIG_DEBUG_FS
	btmrvl_debugfs_init(hdev);
#endif

693
	return 0;
694 695 696 697 698

err_hci_register_dev:
	hci_free_dev(hdev);

err_hdev:
699 700 701
	/* Stop the thread servicing the interrupts */
	kthread_stop(priv->main_thread.task);

702
	btmrvl_free_adapter(priv);
703 704 705 706 707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733
	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");
734 735
	if (IS_ERR(priv->main_thread.task))
		goto err_thread;
736 737 738 739 740

	priv->btmrvl_dev.card = card;
	priv->btmrvl_dev.tx_dnld_rdy = true;

	return priv;
741

742 743 744
err_thread:
	btmrvl_free_adapter(priv);

745 746 747 748 749 750 751 752 753 754 755 756 757 758 759
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);
760
	wake_up_interruptible(&priv->adapter->event_hs_wait_q);
761 762 763

	kthread_stop(priv->main_thread.task);

764 765 766 767
#ifdef CONFIG_DEBUG_FS
	btmrvl_debugfs_remove(hdev);
#endif

768 769 770 771 772 773 774 775 776 777 778 779 780 781 782
	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.");
783
MODULE_DESCRIPTION("Marvell Bluetooth driver ver " VERSION);
784 785
MODULE_VERSION(VERSION);
MODULE_LICENSE("GPL v2");