Linux Audio

Check our new training course

Loading...
v3.1
   1/**
   2 * Marvell BT-over-SDIO driver: SDIO interface related functions.
   3 *
   4 * Copyright (C) 2009, Marvell International Ltd.
   5 *
   6 * This software file (the "File") is distributed by Marvell International
   7 * Ltd. under the terms of the GNU General Public License Version 2, June 1991
   8 * (the "License").  You may use, redistribute and/or modify this File in
   9 * accordance with the terms and conditions of the License, a copy of which
  10 * is available by writing to the Free Software Foundation, Inc.,
  11 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA or on the
  12 * worldwide web at http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt.
  13 *
  14 *
  15 * THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE
  16 * IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE
  17 * ARE EXPRESSLY DISCLAIMED.  The License provides additional details about
  18 * this warranty disclaimer.
  19 **/
  20
  21#include <linux/firmware.h>
  22#include <linux/slab.h>
 
  23
  24#include <linux/mmc/sdio_ids.h>
  25#include <linux/mmc/sdio_func.h>
 
 
  26
  27#include <net/bluetooth/bluetooth.h>
  28#include <net/bluetooth/hci_core.h>
  29
  30#include "btmrvl_drv.h"
  31#include "btmrvl_sdio.h"
  32
  33#define VERSION "1.0"
  34
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
  35/* The btmrvl_sdio_remove() callback function is called
  36 * when user removes this module from kernel space or ejects
  37 * the card from the slot. The driver handles these 2 cases
  38 * differently.
  39 * If the user is removing the module, a MODULE_SHUTDOWN_REQ
  40 * command is sent to firmware and interrupt will be disabled.
  41 * If the card is removed, there is no need to send command
  42 * or disable interrupt.
  43 *
  44 * The variable 'user_rmmod' is used to distinguish these two
  45 * scenarios. This flag is initialized as FALSE in case the card
  46 * is removed, and will be set to TRUE for module removal when
  47 * module_exit function is called.
  48 */
  49static u8 user_rmmod;
  50static u8 sdio_ireg;
  51
  52static const struct btmrvl_sdio_card_reg btmrvl_reg_8688 = {
  53	.cfg = 0x03,
  54	.host_int_mask = 0x04,
  55	.host_intstatus = 0x05,
  56	.card_status = 0x20,
  57	.sq_read_base_addr_a0 = 0x10,
  58	.sq_read_base_addr_a1 = 0x11,
  59	.card_fw_status0 = 0x40,
  60	.card_fw_status1 = 0x41,
  61	.card_rx_len = 0x42,
  62	.card_rx_unit = 0x43,
  63	.io_port_0 = 0x00,
  64	.io_port_1 = 0x01,
  65	.io_port_2 = 0x02,
 
  66};
  67static const struct btmrvl_sdio_card_reg btmrvl_reg_8787 = {
  68	.cfg = 0x00,
  69	.host_int_mask = 0x02,
  70	.host_intstatus = 0x03,
  71	.card_status = 0x30,
  72	.sq_read_base_addr_a0 = 0x40,
  73	.sq_read_base_addr_a1 = 0x41,
  74	.card_revision = 0x5c,
  75	.card_fw_status0 = 0x60,
  76	.card_fw_status1 = 0x61,
  77	.card_rx_len = 0x62,
  78	.card_rx_unit = 0x63,
  79	.io_port_0 = 0x78,
  80	.io_port_1 = 0x79,
  81	.io_port_2 = 0x7a,
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
  82};
  83
  84static const struct btmrvl_sdio_device btmrvl_sdio_sd6888 = {
  85	.helper		= "sd8688_helper.bin",
  86	.firmware	= "sd8688.bin",
  87	.reg		= &btmrvl_reg_8688,
 
  88	.sd_blksz_fw_dl	= 64,
 
  89};
  90
  91static const struct btmrvl_sdio_device btmrvl_sdio_sd8787 = {
  92	.helper		= NULL,
  93	.firmware	= "mrvl/sd8787_uapsta.bin",
  94	.reg		= &btmrvl_reg_8787,
 
  95	.sd_blksz_fw_dl	= 256,
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
  96};
  97
  98static const struct sdio_device_id btmrvl_sdio_ids[] = {
  99	/* Marvell SD8688 Bluetooth device */
 100	{ SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, 0x9105),
 101			.driver_data = (unsigned long) &btmrvl_sdio_sd6888 },
 102	/* Marvell SD8787 Bluetooth device */
 103	{ SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, 0x911A),
 104			.driver_data = (unsigned long) &btmrvl_sdio_sd8787 },
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 105
 106	{ }	/* Terminating entry */
 107};
 108
 109MODULE_DEVICE_TABLE(sdio, btmrvl_sdio_ids);
 110
 111static int btmrvl_sdio_get_rx_unit(struct btmrvl_sdio_card *card)
 112{
 113	u8 reg;
 114	int ret;
 115
 116	reg = sdio_readb(card->func, card->reg->card_rx_unit, &ret);
 117	if (!ret)
 118		card->rx_unit = reg;
 119
 120	return ret;
 121}
 122
 123static int btmrvl_sdio_read_fw_status(struct btmrvl_sdio_card *card, u16 *dat)
 124{
 125	u8 fws0, fws1;
 126	int ret;
 127
 128	*dat = 0;
 129
 130	fws0 = sdio_readb(card->func, card->reg->card_fw_status0, &ret);
 131	if (ret)
 132		return -EIO;
 133
 134	fws1 = sdio_readb(card->func, card->reg->card_fw_status1, &ret);
 135	if (ret)
 136		return -EIO;
 137
 138	*dat = (((u16) fws1) << 8) | fws0;
 139
 140	return 0;
 141}
 142
 143static int btmrvl_sdio_read_rx_len(struct btmrvl_sdio_card *card, u16 *dat)
 144{
 145	u8 reg;
 146	int ret;
 147
 148	reg = sdio_readb(card->func, card->reg->card_rx_len, &ret);
 149	if (!ret)
 150		*dat = (u16) reg << card->rx_unit;
 151
 152	return ret;
 153}
 154
 155static int btmrvl_sdio_enable_host_int_mask(struct btmrvl_sdio_card *card,
 156								u8 mask)
 157{
 158	int ret;
 159
 160	sdio_writeb(card->func, mask, card->reg->host_int_mask, &ret);
 161	if (ret) {
 162		BT_ERR("Unable to enable the host interrupt!");
 163		ret = -EIO;
 164	}
 165
 166	return ret;
 167}
 168
 169static int btmrvl_sdio_disable_host_int_mask(struct btmrvl_sdio_card *card,
 170								u8 mask)
 171{
 172	u8 host_int_mask;
 173	int ret;
 174
 175	host_int_mask = sdio_readb(card->func, card->reg->host_int_mask, &ret);
 176	if (ret)
 177		return -EIO;
 178
 179	host_int_mask &= ~mask;
 180
 181	sdio_writeb(card->func, host_int_mask, card->reg->host_int_mask, &ret);
 182	if (ret < 0) {
 183		BT_ERR("Unable to disable the host interrupt!");
 184		return -EIO;
 185	}
 186
 187	return 0;
 188}
 189
 190static int btmrvl_sdio_poll_card_status(struct btmrvl_sdio_card *card, u8 bits)
 191{
 192	unsigned int tries;
 193	u8 status;
 194	int ret;
 195
 196	for (tries = 0; tries < MAX_POLL_TRIES * 1000; tries++) {
 197		status = sdio_readb(card->func, card->reg->card_status,	&ret);
 198		if (ret)
 199			goto failed;
 200		if ((status & bits) == bits)
 201			return ret;
 202
 203		udelay(1);
 204	}
 205
 206	ret = -ETIMEDOUT;
 207
 208failed:
 209	BT_ERR("FAILED! ret=%d", ret);
 210
 211	return ret;
 212}
 213
 214static int btmrvl_sdio_verify_fw_download(struct btmrvl_sdio_card *card,
 215								int pollnum)
 216{
 217	int ret = -ETIMEDOUT;
 218	u16 firmwarestat;
 219	unsigned int tries;
 220
 221	 /* Wait for firmware to become ready */
 222	for (tries = 0; tries < pollnum; tries++) {
 223		if (btmrvl_sdio_read_fw_status(card, &firmwarestat) < 0)
 
 
 
 224			continue;
 225
 226		if (firmwarestat == FIRMWARE_READY) {
 227			ret = 0;
 228			break;
 229		} else {
 230			msleep(10);
 231		}
 232	}
 233
 234	return ret;
 235}
 236
 237static int btmrvl_sdio_download_helper(struct btmrvl_sdio_card *card)
 238{
 239	const struct firmware *fw_helper = NULL;
 240	const u8 *helper = NULL;
 241	int ret;
 242	void *tmphlprbuf = NULL;
 243	int tmphlprbufsz, hlprblknow, helperlen;
 244	u8 *helperbuf;
 245	u32 tx_len;
 246
 247	ret = request_firmware(&fw_helper, card->helper,
 248						&card->func->dev);
 249	if ((ret < 0) || !fw_helper) {
 250		BT_ERR("request_firmware(helper) failed, error code = %d",
 251									ret);
 252		ret = -ENOENT;
 253		goto done;
 254	}
 255
 256	helper = fw_helper->data;
 257	helperlen = fw_helper->size;
 258
 259	BT_DBG("Downloading helper image (%d bytes), block size %d bytes",
 260						helperlen, SDIO_BLOCK_SIZE);
 261
 262	tmphlprbufsz = ALIGN_SZ(BTM_UPLD_SIZE, BTSDIO_DMA_ALIGN);
 263
 264	tmphlprbuf = kzalloc(tmphlprbufsz, GFP_KERNEL);
 265	if (!tmphlprbuf) {
 266		BT_ERR("Unable to allocate buffer for helper."
 267			" Terminating download");
 268		ret = -ENOMEM;
 269		goto done;
 270	}
 271
 272	helperbuf = (u8 *) ALIGN_ADDR(tmphlprbuf, BTSDIO_DMA_ALIGN);
 273
 274	/* Perform helper data transfer */
 275	tx_len = (FIRMWARE_TRANSFER_NBLOCK * SDIO_BLOCK_SIZE)
 276			- SDIO_HEADER_LEN;
 277	hlprblknow = 0;
 278
 279	do {
 280		ret = btmrvl_sdio_poll_card_status(card,
 281					    CARD_IO_READY | DN_LD_CARD_RDY);
 282		if (ret < 0) {
 283			BT_ERR("Helper download poll status timeout @ %d",
 284				hlprblknow);
 285			goto done;
 286		}
 287
 288		/* Check if there is more data? */
 289		if (hlprblknow >= helperlen)
 290			break;
 291
 292		if (helperlen - hlprblknow < tx_len)
 293			tx_len = helperlen - hlprblknow;
 294
 295		/* Little-endian */
 296		helperbuf[0] = ((tx_len & 0x000000ff) >> 0);
 297		helperbuf[1] = ((tx_len & 0x0000ff00) >> 8);
 298		helperbuf[2] = ((tx_len & 0x00ff0000) >> 16);
 299		helperbuf[3] = ((tx_len & 0xff000000) >> 24);
 300
 301		memcpy(&helperbuf[SDIO_HEADER_LEN], &helper[hlprblknow],
 302				tx_len);
 303
 304		/* Now send the data */
 305		ret = sdio_writesb(card->func, card->ioport, helperbuf,
 306				FIRMWARE_TRANSFER_NBLOCK * SDIO_BLOCK_SIZE);
 307		if (ret < 0) {
 308			BT_ERR("IO error during helper download @ %d",
 309				hlprblknow);
 310			goto done;
 311		}
 312
 313		hlprblknow += tx_len;
 314	} while (true);
 315
 316	BT_DBG("Transferring helper image EOF block");
 317
 318	memset(helperbuf, 0x0, SDIO_BLOCK_SIZE);
 319
 320	ret = sdio_writesb(card->func, card->ioport, helperbuf,
 321							SDIO_BLOCK_SIZE);
 322	if (ret < 0) {
 323		BT_ERR("IO error in writing helper image EOF block");
 324		goto done;
 325	}
 326
 327	ret = 0;
 328
 329done:
 330	kfree(tmphlprbuf);
 331	if (fw_helper)
 332		release_firmware(fw_helper);
 333
 334	return ret;
 335}
 336
 337static int btmrvl_sdio_download_fw_w_helper(struct btmrvl_sdio_card *card)
 338{
 339	const struct firmware *fw_firmware = NULL;
 340	const u8 *firmware = NULL;
 341	int firmwarelen, tmpfwbufsz, ret;
 342	unsigned int tries, offset;
 343	u8 base0, base1;
 344	void *tmpfwbuf = NULL;
 345	u8 *fwbuf;
 346	u16 len, blksz_dl = card->sd_blksz_fw_dl;
 347	int txlen = 0, tx_blocks = 0, count = 0;
 348
 349	ret = request_firmware(&fw_firmware, card->firmware,
 350							&card->func->dev);
 351	if ((ret < 0) || !fw_firmware) {
 352		BT_ERR("request_firmware(firmware) failed, error code = %d",
 353									ret);
 354		ret = -ENOENT;
 355		goto done;
 356	}
 357
 358	firmware = fw_firmware->data;
 359	firmwarelen = fw_firmware->size;
 360
 361	BT_DBG("Downloading FW image (%d bytes)", firmwarelen);
 362
 363	tmpfwbufsz = ALIGN_SZ(BTM_UPLD_SIZE, BTSDIO_DMA_ALIGN);
 364	tmpfwbuf = kzalloc(tmpfwbufsz, GFP_KERNEL);
 365	if (!tmpfwbuf) {
 366		BT_ERR("Unable to allocate buffer for firmware."
 367		       " Terminating download");
 368		ret = -ENOMEM;
 369		goto done;
 370	}
 371
 372	/* Ensure aligned firmware buffer */
 373	fwbuf = (u8 *) ALIGN_ADDR(tmpfwbuf, BTSDIO_DMA_ALIGN);
 374
 375	/* Perform firmware data transfer */
 376	offset = 0;
 377	do {
 378		ret = btmrvl_sdio_poll_card_status(card,
 379					CARD_IO_READY | DN_LD_CARD_RDY);
 380		if (ret < 0) {
 381			BT_ERR("FW download with helper poll status"
 382						" timeout @ %d", offset);
 383			goto done;
 384		}
 385
 386		/* Check if there is more data ? */
 387		if (offset >= firmwarelen)
 388			break;
 389
 390		for (tries = 0; tries < MAX_POLL_TRIES; tries++) {
 391			base0 = sdio_readb(card->func,
 392					card->reg->sq_read_base_addr_a0, &ret);
 393			if (ret) {
 394				BT_ERR("BASE0 register read failed:"
 395					" base0 = 0x%04X(%d)."
 396					" Terminating download",
 397					base0, base0);
 398				ret = -EIO;
 399				goto done;
 400			}
 401			base1 = sdio_readb(card->func,
 402					card->reg->sq_read_base_addr_a1, &ret);
 403			if (ret) {
 404				BT_ERR("BASE1 register read failed:"
 405					" base1 = 0x%04X(%d)."
 406					" Terminating download",
 407					base1, base1);
 408				ret = -EIO;
 409				goto done;
 410			}
 411
 412			len = (((u16) base1) << 8) | base0;
 413			if (len)
 414				break;
 415
 416			udelay(10);
 417		}
 418
 419		if (!len)
 420			break;
 421		else if (len > BTM_UPLD_SIZE) {
 422			BT_ERR("FW download failure @%d, invalid length %d",
 423								offset, len);
 424			ret = -EINVAL;
 425			goto done;
 426		}
 427
 428		txlen = len;
 429
 430		if (len & BIT(0)) {
 431			count++;
 432			if (count > MAX_WRITE_IOMEM_RETRY) {
 433				BT_ERR("FW download failure @%d, "
 434					"over max retry count", offset);
 435				ret = -EIO;
 436				goto done;
 437			}
 438			BT_ERR("FW CRC error indicated by the helper: "
 439				"len = 0x%04X, txlen = %d", len, txlen);
 440			len &= ~BIT(0);
 441			/* Set txlen to 0 so as to resend from same offset */
 442			txlen = 0;
 443		} else {
 444			count = 0;
 445
 446			/* Last block ? */
 447			if (firmwarelen - offset < txlen)
 448				txlen = firmwarelen - offset;
 449
 450			tx_blocks = (txlen + blksz_dl - 1) / blksz_dl;
 451
 452			memcpy(fwbuf, &firmware[offset], txlen);
 453		}
 454
 455		ret = sdio_writesb(card->func, card->ioport, fwbuf,
 456						tx_blocks * blksz_dl);
 457
 458		if (ret < 0) {
 459			BT_ERR("FW download, writesb(%d) failed @%d",
 460							count, offset);
 461			sdio_writeb(card->func, HOST_CMD53_FIN,
 462						card->reg->cfg, &ret);
 463			if (ret)
 464				BT_ERR("writeb failed (CFG)");
 465		}
 466
 467		offset += txlen;
 468	} while (true);
 469
 470	BT_DBG("FW download over, size %d bytes", offset);
 471
 472	ret = 0;
 473
 474done:
 475	kfree(tmpfwbuf);
 476
 477	if (fw_firmware)
 478		release_firmware(fw_firmware);
 479
 480	return ret;
 481}
 482
 483static int btmrvl_sdio_card_to_host(struct btmrvl_private *priv)
 484{
 485	u16 buf_len = 0;
 486	int ret, buf_block_len, blksz;
 487	struct sk_buff *skb = NULL;
 488	u32 type;
 489	u8 *payload = NULL;
 490	struct hci_dev *hdev = priv->btmrvl_dev.hcidev;
 491	struct btmrvl_sdio_card *card = priv->btmrvl_dev.card;
 492
 493	if (!card || !card->func) {
 494		BT_ERR("card or function is NULL!");
 495		ret = -EINVAL;
 496		goto exit;
 497	}
 498
 499	/* Read the length of data to be transferred */
 500	ret = btmrvl_sdio_read_rx_len(card, &buf_len);
 501	if (ret < 0) {
 502		BT_ERR("read rx_len failed");
 503		ret = -EIO;
 504		goto exit;
 505	}
 506
 507	blksz = SDIO_BLOCK_SIZE;
 508	buf_block_len = (buf_len + blksz - 1) / blksz;
 509
 510	if (buf_len <= SDIO_HEADER_LEN
 511			|| (buf_block_len * blksz) > ALLOC_BUF_SIZE) {
 512		BT_ERR("invalid packet length: %d", buf_len);
 513		ret = -EINVAL;
 514		goto exit;
 515	}
 516
 517	/* Allocate buffer */
 518	skb = bt_skb_alloc(buf_block_len * blksz + BTSDIO_DMA_ALIGN,
 519								GFP_ATOMIC);
 520	if (skb == NULL) {
 521		BT_ERR("No free skb");
 
 522		goto exit;
 523	}
 524
 525	if ((unsigned long) skb->data & (BTSDIO_DMA_ALIGN - 1)) {
 526		skb_put(skb, (unsigned long) skb->data &
 527					(BTSDIO_DMA_ALIGN - 1));
 528		skb_pull(skb, (unsigned long) skb->data &
 529					(BTSDIO_DMA_ALIGN - 1));
 530	}
 531
 532	payload = skb->data;
 533
 534	ret = sdio_readsb(card->func, payload, card->ioport,
 535			  buf_block_len * blksz);
 536	if (ret < 0) {
 537		BT_ERR("readsb failed: %d", ret);
 538		ret = -EIO;
 539		goto exit;
 540	}
 541
 542	/* This is SDIO specific header length: byte[2][1][0], type: byte[3]
 543	 * (HCI_COMMAND = 1, ACL_DATA = 2, SCO_DATA = 3, 0xFE = Vendor)
 544	 */
 545
 546	buf_len = payload[0];
 547	buf_len |= (u16) payload[1] << 8;
 
 
 
 
 
 
 
 
 
 548	type = payload[3];
 549
 550	switch (type) {
 551	case HCI_ACLDATA_PKT:
 552	case HCI_SCODATA_PKT:
 553	case HCI_EVENT_PKT:
 554		bt_cb(skb)->pkt_type = type;
 555		skb->dev = (void *)hdev;
 556		skb_put(skb, buf_len);
 557		skb_pull(skb, SDIO_HEADER_LEN);
 558
 559		if (type == HCI_EVENT_PKT)
 560			btmrvl_check_evtpkt(priv, skb);
 
 
 
 
 561
 562		hci_recv_frame(skb);
 563		hdev->stat.byte_rx += buf_len;
 564		break;
 565
 566	case MRVL_VENDOR_PKT:
 567		bt_cb(skb)->pkt_type = HCI_VENDOR_PKT;
 568		skb->dev = (void *)hdev;
 569		skb_put(skb, buf_len);
 570		skb_pull(skb, SDIO_HEADER_LEN);
 571
 572		if (btmrvl_process_event(priv, skb))
 573			hci_recv_frame(skb);
 574
 575		hdev->stat.byte_rx += buf_len;
 576		break;
 577
 578	default:
 579		BT_ERR("Unknown packet type:%d", type);
 580		print_hex_dump_bytes("", DUMP_PREFIX_OFFSET, payload,
 581						blksz * buf_block_len);
 582
 583		kfree_skb(skb);
 584		skb = NULL;
 585		break;
 586	}
 587
 588exit:
 589	if (ret) {
 590		hdev->stat.err_rx++;
 591		if (skb)
 592			kfree_skb(skb);
 593	}
 594
 595	return ret;
 596}
 597
 598static int btmrvl_sdio_process_int_status(struct btmrvl_private *priv)
 599{
 600	ulong flags;
 601	u8 ireg;
 602	struct btmrvl_sdio_card *card = priv->btmrvl_dev.card;
 603
 604	spin_lock_irqsave(&priv->driver_lock, flags);
 605	ireg = sdio_ireg;
 606	sdio_ireg = 0;
 607	spin_unlock_irqrestore(&priv->driver_lock, flags);
 608
 609	sdio_claim_host(card->func);
 610	if (ireg & DN_LD_HOST_INT_STATUS) {
 611		if (priv->btmrvl_dev.tx_dnld_rdy)
 612			BT_DBG("tx_done already received: "
 613				" int_status=0x%x", ireg);
 614		else
 615			priv->btmrvl_dev.tx_dnld_rdy = true;
 616	}
 617
 618	if (ireg & UP_LD_HOST_INT_STATUS)
 619		btmrvl_sdio_card_to_host(priv);
 620
 621	sdio_release_host(card->func);
 622
 623	return 0;
 624}
 625
 626static void btmrvl_sdio_interrupt(struct sdio_func *func)
 627{
 628	struct btmrvl_private *priv;
 629	struct btmrvl_sdio_card *card;
 630	ulong flags;
 631	u8 ireg = 0;
 632	int ret;
 633
 634	card = sdio_get_drvdata(func);
 635	if (!card || !card->priv) {
 636		BT_ERR("sbi_interrupt(%p) card or priv is "
 637				"NULL, card=%p\n", func, card);
 638		return;
 639	}
 640
 641	priv = card->priv;
 
 642
 643	ireg = sdio_readb(card->func, card->reg->host_intstatus, &ret);
 
 
 
 
 
 
 
 644	if (ret) {
 645		BT_ERR("sdio_readb: read int status register failed");
 646		return;
 647	}
 648
 649	if (ireg != 0) {
 650		/*
 651		 * DN_LD_HOST_INT_STATUS and/or UP_LD_HOST_INT_STATUS
 652		 * Clear the interrupt status register and re-enable the
 653		 * interrupt.
 654		 */
 655		BT_DBG("ireg = 0x%x", ireg);
 656
 657		sdio_writeb(card->func, ~(ireg) & (DN_LD_HOST_INT_STATUS |
 658					UP_LD_HOST_INT_STATUS),
 659				card->reg->host_intstatus, &ret);
 660		if (ret) {
 661			BT_ERR("sdio_writeb: clear int status register failed");
 662			return;
 663		}
 664	}
 665
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 666	spin_lock_irqsave(&priv->driver_lock, flags);
 667	sdio_ireg |= ireg;
 668	spin_unlock_irqrestore(&priv->driver_lock, flags);
 669
 670	btmrvl_interrupt(priv);
 671}
 672
 673static int btmrvl_sdio_register_dev(struct btmrvl_sdio_card *card)
 674{
 675	struct sdio_func *func;
 676	u8 reg;
 677	int ret = 0;
 678
 679	if (!card || !card->func) {
 680		BT_ERR("Error: card or function is NULL!");
 681		ret = -EINVAL;
 682		goto failed;
 683	}
 684
 685	func = card->func;
 686
 687	sdio_claim_host(func);
 688
 689	ret = sdio_enable_func(func);
 690	if (ret) {
 691		BT_ERR("sdio_enable_func() failed: ret=%d", ret);
 692		ret = -EIO;
 693		goto release_host;
 694	}
 695
 696	ret = sdio_claim_irq(func, btmrvl_sdio_interrupt);
 697	if (ret) {
 698		BT_ERR("sdio_claim_irq failed: ret=%d", ret);
 699		ret = -EIO;
 700		goto disable_func;
 701	}
 702
 703	ret = sdio_set_block_size(card->func, SDIO_BLOCK_SIZE);
 704	if (ret) {
 705		BT_ERR("cannot set SDIO block size");
 706		ret = -EIO;
 707		goto release_irq;
 708	}
 709
 710	reg = sdio_readb(func, card->reg->io_port_0, &ret);
 711	if (ret < 0) {
 712		ret = -EIO;
 713		goto release_irq;
 714	}
 715
 716	card->ioport = reg;
 717
 718	reg = sdio_readb(func, card->reg->io_port_1, &ret);
 719	if (ret < 0) {
 720		ret = -EIO;
 721		goto release_irq;
 722	}
 723
 724	card->ioport |= (reg << 8);
 725
 726	reg = sdio_readb(func, card->reg->io_port_2, &ret);
 727	if (ret < 0) {
 728		ret = -EIO;
 729		goto release_irq;
 730	}
 731
 732	card->ioport |= (reg << 16);
 733
 734	BT_DBG("SDIO FUNC%d IO port: 0x%x", func->num, card->ioport);
 735
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 736	sdio_set_drvdata(func, card);
 737
 738	sdio_release_host(func);
 739
 740	return 0;
 741
 742release_irq:
 743	sdio_release_irq(func);
 744
 745disable_func:
 746	sdio_disable_func(func);
 747
 748release_host:
 749	sdio_release_host(func);
 750
 751failed:
 752	return ret;
 753}
 754
 755static int btmrvl_sdio_unregister_dev(struct btmrvl_sdio_card *card)
 756{
 757	if (card && card->func) {
 758		sdio_claim_host(card->func);
 759		sdio_release_irq(card->func);
 760		sdio_disable_func(card->func);
 761		sdio_release_host(card->func);
 762		sdio_set_drvdata(card->func, NULL);
 763	}
 764
 765	return 0;
 766}
 767
 768static int btmrvl_sdio_enable_host_int(struct btmrvl_sdio_card *card)
 769{
 770	int ret;
 771
 772	if (!card || !card->func)
 773		return -EINVAL;
 774
 775	sdio_claim_host(card->func);
 776
 777	ret = btmrvl_sdio_enable_host_int_mask(card, HIM_ENABLE);
 778
 779	btmrvl_sdio_get_rx_unit(card);
 780
 781	sdio_release_host(card->func);
 782
 783	return ret;
 784}
 785
 786static int btmrvl_sdio_disable_host_int(struct btmrvl_sdio_card *card)
 787{
 788	int ret;
 789
 790	if (!card || !card->func)
 791		return -EINVAL;
 792
 793	sdio_claim_host(card->func);
 794
 795	ret = btmrvl_sdio_disable_host_int_mask(card, HIM_DISABLE);
 796
 797	sdio_release_host(card->func);
 798
 799	return ret;
 800}
 801
 802static int btmrvl_sdio_host_to_card(struct btmrvl_private *priv,
 803				u8 *payload, u16 nb)
 804{
 805	struct btmrvl_sdio_card *card = priv->btmrvl_dev.card;
 806	int ret = 0;
 807	int buf_block_len;
 808	int blksz;
 809	int i = 0;
 810	u8 *buf = NULL;
 811	void *tmpbuf = NULL;
 812	int tmpbufsz;
 813
 814	if (!card || !card->func) {
 815		BT_ERR("card or function is NULL!");
 816		return -EINVAL;
 817	}
 818
 
 
 819	buf = payload;
 820	if ((unsigned long) payload & (BTSDIO_DMA_ALIGN - 1)) {
 821		tmpbufsz = ALIGN_SZ(nb, BTSDIO_DMA_ALIGN);
 
 
 822		tmpbuf = kzalloc(tmpbufsz, GFP_KERNEL);
 823		if (!tmpbuf)
 824			return -ENOMEM;
 825		buf = (u8 *) ALIGN_ADDR(tmpbuf, BTSDIO_DMA_ALIGN);
 826		memcpy(buf, payload, nb);
 827	}
 828
 829	blksz = SDIO_BLOCK_SIZE;
 830	buf_block_len = (nb + blksz - 1) / blksz;
 831
 832	sdio_claim_host(card->func);
 833
 834	do {
 835		/* Transfer data to card */
 836		ret = sdio_writesb(card->func, card->ioport, buf,
 837				   buf_block_len * blksz);
 838		if (ret < 0) {
 839			i++;
 840			BT_ERR("i=%d writesb failed: %d", i, ret);
 841			print_hex_dump_bytes("", DUMP_PREFIX_OFFSET,
 842						payload, nb);
 843			ret = -EIO;
 844			if (i > MAX_WRITE_IOMEM_RETRY)
 845				goto exit;
 846		}
 847	} while (ret);
 848
 849	priv->btmrvl_dev.tx_dnld_rdy = false;
 850
 851exit:
 852	sdio_release_host(card->func);
 853	kfree(tmpbuf);
 854
 855	return ret;
 856}
 857
 858static int btmrvl_sdio_download_fw(struct btmrvl_sdio_card *card)
 859{
 860	int ret = 0;
 861	u8 fws0;
 862	int pollnum = MAX_POLL_TRIES;
 863
 864	if (!card || !card->func) {
 865		BT_ERR("card or function is NULL!");
 866		return -EINVAL;
 867	}
 868	sdio_claim_host(card->func);
 869
 870	if (!btmrvl_sdio_verify_fw_download(card, 1)) {
 871		BT_DBG("Firmware already downloaded!");
 872		goto done;
 873	}
 874
 
 
 875	/* Check if other function driver is downloading the firmware */
 876	fws0 = sdio_readb(card->func, card->reg->card_fw_status0, &ret);
 877	if (ret) {
 878		BT_ERR("Failed to read FW downloading status!");
 879		ret = -EIO;
 880		goto done;
 881	}
 882	if (fws0) {
 883		BT_DBG("BT not the winner (%#x). Skip FW downloading", fws0);
 884
 885		/* Give other function more time to download the firmware */
 886		pollnum *= 10;
 887	} else {
 888		if (card->helper) {
 889			ret = btmrvl_sdio_download_helper(card);
 890			if (ret) {
 891				BT_ERR("Failed to download helper!");
 892				ret = -EIO;
 893				goto done;
 894			}
 895		}
 896
 897		if (btmrvl_sdio_download_fw_w_helper(card)) {
 898			BT_ERR("Failed to download firmware!");
 899			ret = -EIO;
 900			goto done;
 901		}
 902	}
 903
 
 
 
 
 904	if (btmrvl_sdio_verify_fw_download(card, pollnum)) {
 905		BT_ERR("FW failed to be active in time!");
 906		ret = -ETIMEDOUT;
 907		goto done;
 908	}
 909
 910done:
 911	sdio_release_host(card->func);
 912
 
 
 
 
 913	return ret;
 914}
 915
 916static int btmrvl_sdio_wakeup_fw(struct btmrvl_private *priv)
 917{
 918	struct btmrvl_sdio_card *card = priv->btmrvl_dev.card;
 919	int ret = 0;
 920
 921	if (!card || !card->func) {
 922		BT_ERR("card or function is NULL!");
 923		return -EINVAL;
 924	}
 925
 926	sdio_claim_host(card->func);
 927
 928	sdio_writeb(card->func, HOST_POWER_UP, card->reg->cfg, &ret);
 929
 930	sdio_release_host(card->func);
 931
 932	BT_DBG("wake up firmware");
 933
 934	return ret;
 935}
 936
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 937static int btmrvl_sdio_probe(struct sdio_func *func,
 938					const struct sdio_device_id *id)
 939{
 940	int ret = 0;
 941	struct btmrvl_private *priv = NULL;
 942	struct btmrvl_sdio_card *card = NULL;
 943
 944	BT_INFO("vendor=0x%x, device=0x%x, class=%d, fn=%d",
 945			id->vendor, id->device, id->class, func->num);
 946
 947	card = kzalloc(sizeof(*card), GFP_KERNEL);
 948	if (!card) {
 949		ret = -ENOMEM;
 950		goto done;
 951	}
 952
 953	card->func = func;
 954
 955	if (id->driver_data) {
 956		struct btmrvl_sdio_device *data = (void *) id->driver_data;
 957		card->helper = data->helper;
 958		card->firmware = data->firmware;
 959		card->reg = data->reg;
 960		card->sd_blksz_fw_dl = data->sd_blksz_fw_dl;
 
 
 961	}
 962
 963	if (btmrvl_sdio_register_dev(card) < 0) {
 964		BT_ERR("Failed to register BT device!");
 965		ret = -ENODEV;
 966		goto free_card;
 967	}
 968
 969	/* Disable the interrupts on the card */
 970	btmrvl_sdio_disable_host_int(card);
 971
 972	if (btmrvl_sdio_download_fw(card)) {
 973		BT_ERR("Downloading firmware failed!");
 974		ret = -ENODEV;
 975		goto unreg_dev;
 976	}
 977
 978	msleep(100);
 979
 980	btmrvl_sdio_enable_host_int(card);
 981
 
 
 
 982	priv = btmrvl_add_card(card);
 983	if (!priv) {
 984		BT_ERR("Initializing card failed!");
 985		ret = -ENODEV;
 986		goto disable_host_int;
 987	}
 988
 989	card->priv = priv;
 990
 991	/* Initialize the interface specific function pointers */
 992	priv->hw_host_to_card = btmrvl_sdio_host_to_card;
 993	priv->hw_wakeup_firmware = btmrvl_sdio_wakeup_fw;
 994	priv->hw_process_int_status = btmrvl_sdio_process_int_status;
 995
 996	if (btmrvl_register_hdev(priv)) {
 997		BT_ERR("Register hdev failed!");
 998		ret = -ENODEV;
 999		goto disable_host_int;
1000	}
1001
1002	priv->btmrvl_dev.psmode = 1;
1003	btmrvl_enable_ps(priv);
1004
1005	return 0;
1006
1007disable_host_int:
1008	btmrvl_sdio_disable_host_int(card);
1009unreg_dev:
1010	btmrvl_sdio_unregister_dev(card);
1011free_card:
1012	kfree(card);
1013done:
1014	return ret;
1015}
1016
1017static void btmrvl_sdio_remove(struct sdio_func *func)
1018{
1019	struct btmrvl_sdio_card *card;
1020
1021	if (func) {
1022		card = sdio_get_drvdata(func);
1023		if (card) {
1024			/* Send SHUTDOWN command & disable interrupt
1025			 * if user removes the module.
1026			 */
1027			if (user_rmmod) {
1028				btmrvl_send_module_cfg_cmd(card->priv,
1029							MODULE_SHUTDOWN_REQ);
1030				btmrvl_sdio_disable_host_int(card);
1031			}
1032			BT_DBG("unregester dev");
 
1033			btmrvl_sdio_unregister_dev(card);
1034			btmrvl_remove_card(card->priv);
1035			kfree(card);
1036		}
1037	}
1038}
1039
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1040static struct sdio_driver bt_mrvl_sdio = {
1041	.name		= "btmrvl_sdio",
1042	.id_table	= btmrvl_sdio_ids,
1043	.probe		= btmrvl_sdio_probe,
1044	.remove		= btmrvl_sdio_remove,
 
 
 
 
 
1045};
1046
1047static int __init btmrvl_sdio_init_module(void)
1048{
1049	if (sdio_register_driver(&bt_mrvl_sdio) != 0) {
1050		BT_ERR("SDIO Driver Registration Failed");
1051		return -ENODEV;
1052	}
1053
1054	/* Clear the flag in case user removes the card. */
1055	user_rmmod = 0;
1056
1057	return 0;
1058}
1059
1060static void __exit btmrvl_sdio_exit_module(void)
1061{
1062	/* Set the flag as user is removing this module. */
1063	user_rmmod = 1;
1064
1065	sdio_unregister_driver(&bt_mrvl_sdio);
1066}
1067
1068module_init(btmrvl_sdio_init_module);
1069module_exit(btmrvl_sdio_exit_module);
1070
1071MODULE_AUTHOR("Marvell International Ltd.");
1072MODULE_DESCRIPTION("Marvell BT-over-SDIO driver ver " VERSION);
1073MODULE_VERSION(VERSION);
1074MODULE_LICENSE("GPL v2");
1075MODULE_FIRMWARE("sd8688_helper.bin");
1076MODULE_FIRMWARE("sd8688.bin");
1077MODULE_FIRMWARE("mrvl/sd8787_uapsta.bin");
v5.4
   1/**
   2 * Marvell BT-over-SDIO driver: SDIO interface related functions.
   3 *
   4 * Copyright (C) 2009, Marvell International Ltd.
   5 *
   6 * This software file (the "File") is distributed by Marvell International
   7 * Ltd. under the terms of the GNU General Public License Version 2, June 1991
   8 * (the "License").  You may use, redistribute and/or modify this File in
   9 * accordance with the terms and conditions of the License, a copy of which
  10 * is available by writing to the Free Software Foundation, Inc.,
  11 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA or on the
  12 * worldwide web at http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt.
  13 *
  14 *
  15 * THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE
  16 * IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE
  17 * ARE EXPRESSLY DISCLAIMED.  The License provides additional details about
  18 * this warranty disclaimer.
  19 **/
  20
  21#include <linux/firmware.h>
  22#include <linux/slab.h>
  23#include <linux/suspend.h>
  24
  25#include <linux/mmc/sdio_ids.h>
  26#include <linux/mmc/sdio_func.h>
  27#include <linux/module.h>
  28#include <linux/devcoredump.h>
  29
  30#include <net/bluetooth/bluetooth.h>
  31#include <net/bluetooth/hci_core.h>
  32
  33#include "btmrvl_drv.h"
  34#include "btmrvl_sdio.h"
  35
  36#define VERSION "1.0"
  37
  38static struct memory_type_mapping mem_type_mapping_tbl[] = {
  39	{"ITCM", NULL, 0, 0xF0},
  40	{"DTCM", NULL, 0, 0xF1},
  41	{"SQRAM", NULL, 0, 0xF2},
  42	{"APU", NULL, 0, 0xF3},
  43	{"CIU", NULL, 0, 0xF4},
  44	{"ICU", NULL, 0, 0xF5},
  45	{"MAC", NULL, 0, 0xF6},
  46	{"EXT7", NULL, 0, 0xF7},
  47	{"EXT8", NULL, 0, 0xF8},
  48	{"EXT9", NULL, 0, 0xF9},
  49	{"EXT10", NULL, 0, 0xFA},
  50	{"EXT11", NULL, 0, 0xFB},
  51	{"EXT12", NULL, 0, 0xFC},
  52	{"EXT13", NULL, 0, 0xFD},
  53	{"EXTLAST", NULL, 0, 0xFE},
  54};
  55
  56static const struct of_device_id btmrvl_sdio_of_match_table[] = {
  57	{ .compatible = "marvell,sd8897-bt" },
  58	{ .compatible = "marvell,sd8997-bt" },
  59	{ }
  60};
  61
  62static irqreturn_t btmrvl_wake_irq_bt(int irq, void *priv)
  63{
  64	struct btmrvl_sdio_card *card = priv;
  65	struct device *dev = &card->func->dev;
  66	struct btmrvl_plt_wake_cfg *cfg = card->plt_wake_cfg;
  67
  68	dev_info(dev, "wake by bt\n");
  69	cfg->wake_by_bt = true;
  70	disable_irq_nosync(irq);
  71
  72	pm_wakeup_event(dev, 0);
  73	pm_system_wakeup();
  74
  75	return IRQ_HANDLED;
  76}
  77
  78/* This function parses device tree node using mmc subnode devicetree API.
  79 * The device node is saved in card->plt_of_node.
  80 * If the device tree node exists and includes interrupts attributes, this
  81 * function will request platform specific wakeup interrupt.
  82 */
  83static int btmrvl_sdio_probe_of(struct device *dev,
  84				struct btmrvl_sdio_card *card)
  85{
  86	struct btmrvl_plt_wake_cfg *cfg;
  87	int ret;
  88
  89	if (!dev->of_node ||
  90	    !of_match_node(btmrvl_sdio_of_match_table, dev->of_node)) {
  91		dev_info(dev, "sdio device tree data not available\n");
  92		return -1;
  93	}
  94
  95	card->plt_of_node = dev->of_node;
  96
  97	card->plt_wake_cfg = devm_kzalloc(dev, sizeof(*card->plt_wake_cfg),
  98					  GFP_KERNEL);
  99	cfg = card->plt_wake_cfg;
 100	if (cfg && card->plt_of_node) {
 101		cfg->irq_bt = irq_of_parse_and_map(card->plt_of_node, 0);
 102		if (!cfg->irq_bt) {
 103			dev_err(dev, "fail to parse irq_bt from device tree\n");
 104			cfg->irq_bt = -1;
 105		} else {
 106			ret = devm_request_irq(dev, cfg->irq_bt,
 107					       btmrvl_wake_irq_bt,
 108					       0, "bt_wake", card);
 109			if (ret) {
 110				dev_err(dev,
 111					"Failed to request irq_bt %d (%d)\n",
 112					cfg->irq_bt, ret);
 113			}
 114			disable_irq(cfg->irq_bt);
 115		}
 116	}
 117
 118	return 0;
 119}
 120
 121/* The btmrvl_sdio_remove() callback function is called
 122 * when user removes this module from kernel space or ejects
 123 * the card from the slot. The driver handles these 2 cases
 124 * differently.
 125 * If the user is removing the module, a MODULE_SHUTDOWN_REQ
 126 * command is sent to firmware and interrupt will be disabled.
 127 * If the card is removed, there is no need to send command
 128 * or disable interrupt.
 129 *
 130 * The variable 'user_rmmod' is used to distinguish these two
 131 * scenarios. This flag is initialized as FALSE in case the card
 132 * is removed, and will be set to TRUE for module removal when
 133 * module_exit function is called.
 134 */
 135static u8 user_rmmod;
 136static u8 sdio_ireg;
 137
 138static const struct btmrvl_sdio_card_reg btmrvl_reg_8688 = {
 139	.cfg = 0x03,
 140	.host_int_mask = 0x04,
 141	.host_intstatus = 0x05,
 142	.card_status = 0x20,
 143	.sq_read_base_addr_a0 = 0x10,
 144	.sq_read_base_addr_a1 = 0x11,
 145	.card_fw_status0 = 0x40,
 146	.card_fw_status1 = 0x41,
 147	.card_rx_len = 0x42,
 148	.card_rx_unit = 0x43,
 149	.io_port_0 = 0x00,
 150	.io_port_1 = 0x01,
 151	.io_port_2 = 0x02,
 152	.int_read_to_clear = false,
 153};
 154static const struct btmrvl_sdio_card_reg btmrvl_reg_87xx = {
 155	.cfg = 0x00,
 156	.host_int_mask = 0x02,
 157	.host_intstatus = 0x03,
 158	.card_status = 0x30,
 159	.sq_read_base_addr_a0 = 0x40,
 160	.sq_read_base_addr_a1 = 0x41,
 161	.card_revision = 0x5c,
 162	.card_fw_status0 = 0x60,
 163	.card_fw_status1 = 0x61,
 164	.card_rx_len = 0x62,
 165	.card_rx_unit = 0x63,
 166	.io_port_0 = 0x78,
 167	.io_port_1 = 0x79,
 168	.io_port_2 = 0x7a,
 169	.int_read_to_clear = false,
 170};
 171
 172static const struct btmrvl_sdio_card_reg btmrvl_reg_8887 = {
 173	.cfg = 0x00,
 174	.host_int_mask = 0x08,
 175	.host_intstatus = 0x0C,
 176	.card_status = 0x5C,
 177	.sq_read_base_addr_a0 = 0x6C,
 178	.sq_read_base_addr_a1 = 0x6D,
 179	.card_revision = 0xC8,
 180	.card_fw_status0 = 0x88,
 181	.card_fw_status1 = 0x89,
 182	.card_rx_len = 0x8A,
 183	.card_rx_unit = 0x8B,
 184	.io_port_0 = 0xE4,
 185	.io_port_1 = 0xE5,
 186	.io_port_2 = 0xE6,
 187	.int_read_to_clear = true,
 188	.host_int_rsr = 0x04,
 189	.card_misc_cfg = 0xD8,
 190};
 191
 192static const struct btmrvl_sdio_card_reg btmrvl_reg_8897 = {
 193	.cfg = 0x00,
 194	.host_int_mask = 0x02,
 195	.host_intstatus = 0x03,
 196	.card_status = 0x50,
 197	.sq_read_base_addr_a0 = 0x60,
 198	.sq_read_base_addr_a1 = 0x61,
 199	.card_revision = 0xbc,
 200	.card_fw_status0 = 0xc0,
 201	.card_fw_status1 = 0xc1,
 202	.card_rx_len = 0xc2,
 203	.card_rx_unit = 0xc3,
 204	.io_port_0 = 0xd8,
 205	.io_port_1 = 0xd9,
 206	.io_port_2 = 0xda,
 207	.int_read_to_clear = true,
 208	.host_int_rsr = 0x01,
 209	.card_misc_cfg = 0xcc,
 210	.fw_dump_ctrl = 0xe2,
 211	.fw_dump_start = 0xe3,
 212	.fw_dump_end = 0xea,
 213};
 214
 215static const struct btmrvl_sdio_card_reg btmrvl_reg_8977 = {
 216	.cfg = 0x00,
 217	.host_int_mask = 0x08,
 218	.host_intstatus = 0x0c,
 219	.card_status = 0x5c,
 220	.sq_read_base_addr_a0 = 0xf8,
 221	.sq_read_base_addr_a1 = 0xf9,
 222	.card_revision = 0xc8,
 223	.card_fw_status0 = 0xe8,
 224	.card_fw_status1 = 0xe9,
 225	.card_rx_len = 0xea,
 226	.card_rx_unit = 0xeb,
 227	.io_port_0 = 0xe4,
 228	.io_port_1 = 0xe5,
 229	.io_port_2 = 0xe6,
 230	.int_read_to_clear = true,
 231	.host_int_rsr = 0x04,
 232	.card_misc_cfg = 0xD8,
 233	.fw_dump_ctrl = 0xf0,
 234	.fw_dump_start = 0xf1,
 235	.fw_dump_end = 0xf8,
 236};
 237
 238static const struct btmrvl_sdio_card_reg btmrvl_reg_8987 = {
 239	.cfg = 0x00,
 240	.host_int_mask = 0x08,
 241	.host_intstatus = 0x0c,
 242	.card_status = 0x5c,
 243	.sq_read_base_addr_a0 = 0xf8,
 244	.sq_read_base_addr_a1 = 0xf9,
 245	.card_revision = 0xc8,
 246	.card_fw_status0 = 0xe8,
 247	.card_fw_status1 = 0xe9,
 248	.card_rx_len = 0xea,
 249	.card_rx_unit = 0xeb,
 250	.io_port_0 = 0xe4,
 251	.io_port_1 = 0xe5,
 252	.io_port_2 = 0xe6,
 253	.int_read_to_clear = true,
 254	.host_int_rsr = 0x04,
 255	.card_misc_cfg = 0xd8,
 256	.fw_dump_ctrl = 0xf0,
 257	.fw_dump_start = 0xf1,
 258	.fw_dump_end = 0xf8,
 259};
 260
 261static const struct btmrvl_sdio_card_reg btmrvl_reg_8997 = {
 262	.cfg = 0x00,
 263	.host_int_mask = 0x08,
 264	.host_intstatus = 0x0c,
 265	.card_status = 0x5c,
 266	.sq_read_base_addr_a0 = 0xf8,
 267	.sq_read_base_addr_a1 = 0xf9,
 268	.card_revision = 0xc8,
 269	.card_fw_status0 = 0xe8,
 270	.card_fw_status1 = 0xe9,
 271	.card_rx_len = 0xea,
 272	.card_rx_unit = 0xeb,
 273	.io_port_0 = 0xe4,
 274	.io_port_1 = 0xe5,
 275	.io_port_2 = 0xe6,
 276	.int_read_to_clear = true,
 277	.host_int_rsr = 0x04,
 278	.card_misc_cfg = 0xD8,
 279	.fw_dump_ctrl = 0xf0,
 280	.fw_dump_start = 0xf1,
 281	.fw_dump_end = 0xf8,
 282};
 283
 284static const struct btmrvl_sdio_device btmrvl_sdio_sd8688 = {
 285	.helper		= "mrvl/sd8688_helper.bin",
 286	.firmware	= "mrvl/sd8688.bin",
 287	.reg		= &btmrvl_reg_8688,
 288	.support_pscan_win_report = false,
 289	.sd_blksz_fw_dl	= 64,
 290	.supports_fw_dump = false,
 291};
 292
 293static const struct btmrvl_sdio_device btmrvl_sdio_sd8787 = {
 294	.helper		= NULL,
 295	.firmware	= "mrvl/sd8787_uapsta.bin",
 296	.reg		= &btmrvl_reg_87xx,
 297	.support_pscan_win_report = false,
 298	.sd_blksz_fw_dl	= 256,
 299	.supports_fw_dump = false,
 300};
 301
 302static const struct btmrvl_sdio_device btmrvl_sdio_sd8797 = {
 303	.helper		= NULL,
 304	.firmware	= "mrvl/sd8797_uapsta.bin",
 305	.reg		= &btmrvl_reg_87xx,
 306	.support_pscan_win_report = false,
 307	.sd_blksz_fw_dl	= 256,
 308	.supports_fw_dump = false,
 309};
 310
 311static const struct btmrvl_sdio_device btmrvl_sdio_sd8887 = {
 312	.helper		= NULL,
 313	.firmware	= "mrvl/sd8887_uapsta.bin",
 314	.reg		= &btmrvl_reg_8887,
 315	.support_pscan_win_report = true,
 316	.sd_blksz_fw_dl	= 256,
 317	.supports_fw_dump = false,
 318};
 319
 320static const struct btmrvl_sdio_device btmrvl_sdio_sd8897 = {
 321	.helper		= NULL,
 322	.firmware	= "mrvl/sd8897_uapsta.bin",
 323	.reg		= &btmrvl_reg_8897,
 324	.support_pscan_win_report = true,
 325	.sd_blksz_fw_dl	= 256,
 326	.supports_fw_dump = true,
 327};
 328
 329static const struct btmrvl_sdio_device btmrvl_sdio_sd8977 = {
 330	.helper         = NULL,
 331	.firmware       = "mrvl/sd8977_uapsta.bin",
 332	.reg            = &btmrvl_reg_8977,
 333	.support_pscan_win_report = true,
 334	.sd_blksz_fw_dl = 256,
 335	.supports_fw_dump = true,
 336};
 337
 338static const struct btmrvl_sdio_device btmrvl_sdio_sd8987 = {
 339	.helper		= NULL,
 340	.firmware	= "mrvl/sd8987_uapsta.bin",
 341	.reg		= &btmrvl_reg_8987,
 342	.support_pscan_win_report = true,
 343	.sd_blksz_fw_dl	= 256,
 344	.supports_fw_dump = true,
 345};
 346
 347static const struct btmrvl_sdio_device btmrvl_sdio_sd8997 = {
 348	.helper         = NULL,
 349	.firmware       = "mrvl/sd8997_uapsta.bin",
 350	.reg            = &btmrvl_reg_8997,
 351	.support_pscan_win_report = true,
 352	.sd_blksz_fw_dl = 256,
 353	.supports_fw_dump = true,
 354};
 355
 356static const struct sdio_device_id btmrvl_sdio_ids[] = {
 357	/* Marvell SD8688 Bluetooth device */
 358	{ SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, 0x9105),
 359			.driver_data = (unsigned long)&btmrvl_sdio_sd8688 },
 360	/* Marvell SD8787 Bluetooth device */
 361	{ SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, 0x911A),
 362			.driver_data = (unsigned long)&btmrvl_sdio_sd8787 },
 363	/* Marvell SD8787 Bluetooth AMP device */
 364	{ SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, 0x911B),
 365			.driver_data = (unsigned long)&btmrvl_sdio_sd8787 },
 366	/* Marvell SD8797 Bluetooth device */
 367	{ SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, 0x912A),
 368			.driver_data = (unsigned long)&btmrvl_sdio_sd8797 },
 369	/* Marvell SD8887 Bluetooth device */
 370	{ SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, 0x9136),
 371			.driver_data = (unsigned long)&btmrvl_sdio_sd8887 },
 372	/* Marvell SD8897 Bluetooth device */
 373	{ SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, 0x912E),
 374			.driver_data = (unsigned long)&btmrvl_sdio_sd8897 },
 375	/* Marvell SD8977 Bluetooth device */
 376	{ SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, 0x9146),
 377			.driver_data = (unsigned long)&btmrvl_sdio_sd8977 },
 378	/* Marvell SD8987 Bluetooth device */
 379	{ SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, 0x914A),
 380			.driver_data = (unsigned long)&btmrvl_sdio_sd8987 },
 381	/* Marvell SD8997 Bluetooth device */
 382	{ SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, 0x9142),
 383			.driver_data = (unsigned long)&btmrvl_sdio_sd8997 },
 384
 385	{ }	/* Terminating entry */
 386};
 387
 388MODULE_DEVICE_TABLE(sdio, btmrvl_sdio_ids);
 389
 390static int btmrvl_sdio_get_rx_unit(struct btmrvl_sdio_card *card)
 391{
 392	u8 reg;
 393	int ret;
 394
 395	reg = sdio_readb(card->func, card->reg->card_rx_unit, &ret);
 396	if (!ret)
 397		card->rx_unit = reg;
 398
 399	return ret;
 400}
 401
 402static int btmrvl_sdio_read_fw_status(struct btmrvl_sdio_card *card, u16 *dat)
 403{
 404	u8 fws0, fws1;
 405	int ret;
 406
 407	*dat = 0;
 408
 409	fws0 = sdio_readb(card->func, card->reg->card_fw_status0, &ret);
 410	if (ret)
 411		return -EIO;
 412
 413	fws1 = sdio_readb(card->func, card->reg->card_fw_status1, &ret);
 414	if (ret)
 415		return -EIO;
 416
 417	*dat = (((u16) fws1) << 8) | fws0;
 418
 419	return 0;
 420}
 421
 422static int btmrvl_sdio_read_rx_len(struct btmrvl_sdio_card *card, u16 *dat)
 423{
 424	u8 reg;
 425	int ret;
 426
 427	reg = sdio_readb(card->func, card->reg->card_rx_len, &ret);
 428	if (!ret)
 429		*dat = (u16) reg << card->rx_unit;
 430
 431	return ret;
 432}
 433
 434static int btmrvl_sdio_enable_host_int_mask(struct btmrvl_sdio_card *card,
 435								u8 mask)
 436{
 437	int ret;
 438
 439	sdio_writeb(card->func, mask, card->reg->host_int_mask, &ret);
 440	if (ret) {
 441		BT_ERR("Unable to enable the host interrupt!");
 442		ret = -EIO;
 443	}
 444
 445	return ret;
 446}
 447
 448static int btmrvl_sdio_disable_host_int_mask(struct btmrvl_sdio_card *card,
 449								u8 mask)
 450{
 451	u8 host_int_mask;
 452	int ret;
 453
 454	host_int_mask = sdio_readb(card->func, card->reg->host_int_mask, &ret);
 455	if (ret)
 456		return -EIO;
 457
 458	host_int_mask &= ~mask;
 459
 460	sdio_writeb(card->func, host_int_mask, card->reg->host_int_mask, &ret);
 461	if (ret < 0) {
 462		BT_ERR("Unable to disable the host interrupt!");
 463		return -EIO;
 464	}
 465
 466	return 0;
 467}
 468
 469static int btmrvl_sdio_poll_card_status(struct btmrvl_sdio_card *card, u8 bits)
 470{
 471	unsigned int tries;
 472	u8 status;
 473	int ret;
 474
 475	for (tries = 0; tries < MAX_POLL_TRIES * 1000; tries++) {
 476		status = sdio_readb(card->func, card->reg->card_status,	&ret);
 477		if (ret)
 478			goto failed;
 479		if ((status & bits) == bits)
 480			return ret;
 481
 482		udelay(1);
 483	}
 484
 485	ret = -ETIMEDOUT;
 486
 487failed:
 488	BT_ERR("FAILED! ret=%d", ret);
 489
 490	return ret;
 491}
 492
 493static int btmrvl_sdio_verify_fw_download(struct btmrvl_sdio_card *card,
 494								int pollnum)
 495{
 
 496	u16 firmwarestat;
 497	int tries, ret;
 498
 499	 /* Wait for firmware to become ready */
 500	for (tries = 0; tries < pollnum; tries++) {
 501		sdio_claim_host(card->func);
 502		ret = btmrvl_sdio_read_fw_status(card, &firmwarestat);
 503		sdio_release_host(card->func);
 504		if (ret < 0)
 505			continue;
 506
 507		if (firmwarestat == FIRMWARE_READY)
 508			return 0;
 509
 510		msleep(100);
 
 
 511	}
 512
 513	return -ETIMEDOUT;
 514}
 515
 516static int btmrvl_sdio_download_helper(struct btmrvl_sdio_card *card)
 517{
 518	const struct firmware *fw_helper = NULL;
 519	const u8 *helper = NULL;
 520	int ret;
 521	void *tmphlprbuf = NULL;
 522	int tmphlprbufsz, hlprblknow, helperlen;
 523	u8 *helperbuf;
 524	u32 tx_len;
 525
 526	ret = request_firmware(&fw_helper, card->helper,
 527						&card->func->dev);
 528	if ((ret < 0) || !fw_helper) {
 529		BT_ERR("request_firmware(helper) failed, error code = %d",
 530									ret);
 531		ret = -ENOENT;
 532		goto done;
 533	}
 534
 535	helper = fw_helper->data;
 536	helperlen = fw_helper->size;
 537
 538	BT_DBG("Downloading helper image (%d bytes), block size %d bytes",
 539						helperlen, SDIO_BLOCK_SIZE);
 540
 541	tmphlprbufsz = ALIGN_SZ(BTM_UPLD_SIZE, BTSDIO_DMA_ALIGN);
 542
 543	tmphlprbuf = kzalloc(tmphlprbufsz, GFP_KERNEL);
 544	if (!tmphlprbuf) {
 545		BT_ERR("Unable to allocate buffer for helper."
 546			" Terminating download");
 547		ret = -ENOMEM;
 548		goto done;
 549	}
 550
 551	helperbuf = (u8 *) ALIGN_ADDR(tmphlprbuf, BTSDIO_DMA_ALIGN);
 552
 553	/* Perform helper data transfer */
 554	tx_len = (FIRMWARE_TRANSFER_NBLOCK * SDIO_BLOCK_SIZE)
 555			- SDIO_HEADER_LEN;
 556	hlprblknow = 0;
 557
 558	do {
 559		ret = btmrvl_sdio_poll_card_status(card,
 560					    CARD_IO_READY | DN_LD_CARD_RDY);
 561		if (ret < 0) {
 562			BT_ERR("Helper download poll status timeout @ %d",
 563				hlprblknow);
 564			goto done;
 565		}
 566
 567		/* Check if there is more data? */
 568		if (hlprblknow >= helperlen)
 569			break;
 570
 571		if (helperlen - hlprblknow < tx_len)
 572			tx_len = helperlen - hlprblknow;
 573
 574		/* Little-endian */
 575		helperbuf[0] = ((tx_len & 0x000000ff) >> 0);
 576		helperbuf[1] = ((tx_len & 0x0000ff00) >> 8);
 577		helperbuf[2] = ((tx_len & 0x00ff0000) >> 16);
 578		helperbuf[3] = ((tx_len & 0xff000000) >> 24);
 579
 580		memcpy(&helperbuf[SDIO_HEADER_LEN], &helper[hlprblknow],
 581				tx_len);
 582
 583		/* Now send the data */
 584		ret = sdio_writesb(card->func, card->ioport, helperbuf,
 585				FIRMWARE_TRANSFER_NBLOCK * SDIO_BLOCK_SIZE);
 586		if (ret < 0) {
 587			BT_ERR("IO error during helper download @ %d",
 588				hlprblknow);
 589			goto done;
 590		}
 591
 592		hlprblknow += tx_len;
 593	} while (true);
 594
 595	BT_DBG("Transferring helper image EOF block");
 596
 597	memset(helperbuf, 0x0, SDIO_BLOCK_SIZE);
 598
 599	ret = sdio_writesb(card->func, card->ioport, helperbuf,
 600							SDIO_BLOCK_SIZE);
 601	if (ret < 0) {
 602		BT_ERR("IO error in writing helper image EOF block");
 603		goto done;
 604	}
 605
 606	ret = 0;
 607
 608done:
 609	kfree(tmphlprbuf);
 610	release_firmware(fw_helper);
 
 
 611	return ret;
 612}
 613
 614static int btmrvl_sdio_download_fw_w_helper(struct btmrvl_sdio_card *card)
 615{
 616	const struct firmware *fw_firmware = NULL;
 617	const u8 *firmware = NULL;
 618	int firmwarelen, tmpfwbufsz, ret;
 619	unsigned int tries, offset;
 620	u8 base0, base1;
 621	void *tmpfwbuf = NULL;
 622	u8 *fwbuf;
 623	u16 len, blksz_dl = card->sd_blksz_fw_dl;
 624	int txlen = 0, tx_blocks = 0, count = 0;
 625
 626	ret = request_firmware(&fw_firmware, card->firmware,
 627							&card->func->dev);
 628	if ((ret < 0) || !fw_firmware) {
 629		BT_ERR("request_firmware(firmware) failed, error code = %d",
 630									ret);
 631		ret = -ENOENT;
 632		goto done;
 633	}
 634
 635	firmware = fw_firmware->data;
 636	firmwarelen = fw_firmware->size;
 637
 638	BT_DBG("Downloading FW image (%d bytes)", firmwarelen);
 639
 640	tmpfwbufsz = ALIGN_SZ(BTM_UPLD_SIZE, BTSDIO_DMA_ALIGN);
 641	tmpfwbuf = kzalloc(tmpfwbufsz, GFP_KERNEL);
 642	if (!tmpfwbuf) {
 643		BT_ERR("Unable to allocate buffer for firmware."
 644		       " Terminating download");
 645		ret = -ENOMEM;
 646		goto done;
 647	}
 648
 649	/* Ensure aligned firmware buffer */
 650	fwbuf = (u8 *) ALIGN_ADDR(tmpfwbuf, BTSDIO_DMA_ALIGN);
 651
 652	/* Perform firmware data transfer */
 653	offset = 0;
 654	do {
 655		ret = btmrvl_sdio_poll_card_status(card,
 656					CARD_IO_READY | DN_LD_CARD_RDY);
 657		if (ret < 0) {
 658			BT_ERR("FW download with helper poll status"
 659						" timeout @ %d", offset);
 660			goto done;
 661		}
 662
 663		/* Check if there is more data ? */
 664		if (offset >= firmwarelen)
 665			break;
 666
 667		for (tries = 0; tries < MAX_POLL_TRIES; tries++) {
 668			base0 = sdio_readb(card->func,
 669					card->reg->sq_read_base_addr_a0, &ret);
 670			if (ret) {
 671				BT_ERR("BASE0 register read failed:"
 672					" base0 = 0x%04X(%d)."
 673					" Terminating download",
 674					base0, base0);
 675				ret = -EIO;
 676				goto done;
 677			}
 678			base1 = sdio_readb(card->func,
 679					card->reg->sq_read_base_addr_a1, &ret);
 680			if (ret) {
 681				BT_ERR("BASE1 register read failed:"
 682					" base1 = 0x%04X(%d)."
 683					" Terminating download",
 684					base1, base1);
 685				ret = -EIO;
 686				goto done;
 687			}
 688
 689			len = (((u16) base1) << 8) | base0;
 690			if (len)
 691				break;
 692
 693			udelay(10);
 694		}
 695
 696		if (!len)
 697			break;
 698		else if (len > BTM_UPLD_SIZE) {
 699			BT_ERR("FW download failure @%d, invalid length %d",
 700								offset, len);
 701			ret = -EINVAL;
 702			goto done;
 703		}
 704
 705		txlen = len;
 706
 707		if (len & BIT(0)) {
 708			count++;
 709			if (count > MAX_WRITE_IOMEM_RETRY) {
 710				BT_ERR("FW download failure @%d, "
 711					"over max retry count", offset);
 712				ret = -EIO;
 713				goto done;
 714			}
 715			BT_ERR("FW CRC error indicated by the helper: "
 716				"len = 0x%04X, txlen = %d", len, txlen);
 717			len &= ~BIT(0);
 718			/* Set txlen to 0 so as to resend from same offset */
 719			txlen = 0;
 720		} else {
 721			count = 0;
 722
 723			/* Last block ? */
 724			if (firmwarelen - offset < txlen)
 725				txlen = firmwarelen - offset;
 726
 727			tx_blocks = DIV_ROUND_UP(txlen, blksz_dl);
 728
 729			memcpy(fwbuf, &firmware[offset], txlen);
 730		}
 731
 732		ret = sdio_writesb(card->func, card->ioport, fwbuf,
 733						tx_blocks * blksz_dl);
 734
 735		if (ret < 0) {
 736			BT_ERR("FW download, writesb(%d) failed @%d",
 737							count, offset);
 738			sdio_writeb(card->func, HOST_CMD53_FIN,
 739						card->reg->cfg, &ret);
 740			if (ret)
 741				BT_ERR("writeb failed (CFG)");
 742		}
 743
 744		offset += txlen;
 745	} while (true);
 746
 747	BT_INFO("FW download over, size %d bytes", offset);
 748
 749	ret = 0;
 750
 751done:
 752	kfree(tmpfwbuf);
 753	release_firmware(fw_firmware);
 
 
 
 754	return ret;
 755}
 756
 757static int btmrvl_sdio_card_to_host(struct btmrvl_private *priv)
 758{
 759	u16 buf_len = 0;
 760	int ret, num_blocks, blksz;
 761	struct sk_buff *skb = NULL;
 762	u32 type;
 763	u8 *payload;
 764	struct hci_dev *hdev = priv->btmrvl_dev.hcidev;
 765	struct btmrvl_sdio_card *card = priv->btmrvl_dev.card;
 766
 767	if (!card || !card->func) {
 768		BT_ERR("card or function is NULL!");
 769		ret = -EINVAL;
 770		goto exit;
 771	}
 772
 773	/* Read the length of data to be transferred */
 774	ret = btmrvl_sdio_read_rx_len(card, &buf_len);
 775	if (ret < 0) {
 776		BT_ERR("read rx_len failed");
 777		ret = -EIO;
 778		goto exit;
 779	}
 780
 781	blksz = SDIO_BLOCK_SIZE;
 782	num_blocks = DIV_ROUND_UP(buf_len, blksz);
 783
 784	if (buf_len <= SDIO_HEADER_LEN
 785	    || (num_blocks * blksz) > ALLOC_BUF_SIZE) {
 786		BT_ERR("invalid packet length: %d", buf_len);
 787		ret = -EINVAL;
 788		goto exit;
 789	}
 790
 791	/* Allocate buffer */
 792	skb = bt_skb_alloc(num_blocks * blksz + BTSDIO_DMA_ALIGN, GFP_KERNEL);
 793	if (!skb) {
 
 794		BT_ERR("No free skb");
 795		ret = -ENOMEM;
 796		goto exit;
 797	}
 798
 799	if ((unsigned long) skb->data & (BTSDIO_DMA_ALIGN - 1)) {
 800		skb_put(skb, (unsigned long) skb->data &
 801					(BTSDIO_DMA_ALIGN - 1));
 802		skb_pull(skb, (unsigned long) skb->data &
 803					(BTSDIO_DMA_ALIGN - 1));
 804	}
 805
 806	payload = skb->data;
 807
 808	ret = sdio_readsb(card->func, payload, card->ioport,
 809			  num_blocks * blksz);
 810	if (ret < 0) {
 811		BT_ERR("readsb failed: %d", ret);
 812		ret = -EIO;
 813		goto exit;
 814	}
 815
 816	/* This is SDIO specific header length: byte[2][1][0], type: byte[3]
 817	 * (HCI_COMMAND = 1, ACL_DATA = 2, SCO_DATA = 3, 0xFE = Vendor)
 818	 */
 819
 820	buf_len = payload[0];
 821	buf_len |= payload[1] << 8;
 822	buf_len |= payload[2] << 16;
 823
 824	if (buf_len > blksz * num_blocks) {
 825		BT_ERR("Skip incorrect packet: hdrlen %d buffer %d",
 826		       buf_len, blksz * num_blocks);
 827		ret = -EIO;
 828		goto exit;
 829	}
 830
 831	type = payload[3];
 832
 833	switch (type) {
 834	case HCI_ACLDATA_PKT:
 835	case HCI_SCODATA_PKT:
 836	case HCI_EVENT_PKT:
 837		hci_skb_pkt_type(skb) = type;
 
 838		skb_put(skb, buf_len);
 839		skb_pull(skb, SDIO_HEADER_LEN);
 840
 841		if (type == HCI_EVENT_PKT) {
 842			if (btmrvl_check_evtpkt(priv, skb))
 843				hci_recv_frame(hdev, skb);
 844		} else {
 845			hci_recv_frame(hdev, skb);
 846		}
 847
 
 848		hdev->stat.byte_rx += buf_len;
 849		break;
 850
 851	case MRVL_VENDOR_PKT:
 852		hci_skb_pkt_type(skb) = HCI_VENDOR_PKT;
 
 853		skb_put(skb, buf_len);
 854		skb_pull(skb, SDIO_HEADER_LEN);
 855
 856		if (btmrvl_process_event(priv, skb))
 857			hci_recv_frame(hdev, skb);
 858
 859		hdev->stat.byte_rx += buf_len;
 860		break;
 861
 862	default:
 863		BT_ERR("Unknown packet type:%d", type);
 864		BT_ERR("hex: %*ph", blksz * num_blocks, payload);
 
 865
 866		kfree_skb(skb);
 867		skb = NULL;
 868		break;
 869	}
 870
 871exit:
 872	if (ret) {
 873		hdev->stat.err_rx++;
 874		kfree_skb(skb);
 
 875	}
 876
 877	return ret;
 878}
 879
 880static int btmrvl_sdio_process_int_status(struct btmrvl_private *priv)
 881{
 882	ulong flags;
 883	u8 ireg;
 884	struct btmrvl_sdio_card *card = priv->btmrvl_dev.card;
 885
 886	spin_lock_irqsave(&priv->driver_lock, flags);
 887	ireg = sdio_ireg;
 888	sdio_ireg = 0;
 889	spin_unlock_irqrestore(&priv->driver_lock, flags);
 890
 891	sdio_claim_host(card->func);
 892	if (ireg & DN_LD_HOST_INT_STATUS) {
 893		if (priv->btmrvl_dev.tx_dnld_rdy)
 894			BT_DBG("tx_done already received: "
 895				" int_status=0x%x", ireg);
 896		else
 897			priv->btmrvl_dev.tx_dnld_rdy = true;
 898	}
 899
 900	if (ireg & UP_LD_HOST_INT_STATUS)
 901		btmrvl_sdio_card_to_host(priv);
 902
 903	sdio_release_host(card->func);
 904
 905	return 0;
 906}
 907
 908static int btmrvl_sdio_read_to_clear(struct btmrvl_sdio_card *card, u8 *ireg)
 909{
 910	struct btmrvl_adapter *adapter = card->priv->adapter;
 
 
 
 911	int ret;
 912
 913	ret = sdio_readsb(card->func, adapter->hw_regs, 0, SDIO_BLOCK_SIZE);
 914	if (ret) {
 915		BT_ERR("sdio_readsb: read int hw_regs failed: %d", ret);
 916		return ret;
 
 917	}
 918
 919	*ireg = adapter->hw_regs[card->reg->host_intstatus];
 920	BT_DBG("hw_regs[%#x]=%#x", card->reg->host_intstatus, *ireg);
 921
 922	return 0;
 923}
 924
 925static int btmrvl_sdio_write_to_clear(struct btmrvl_sdio_card *card, u8 *ireg)
 926{
 927	int ret;
 928
 929	*ireg = sdio_readb(card->func, card->reg->host_intstatus, &ret);
 930	if (ret) {
 931		BT_ERR("sdio_readb: read int status failed: %d", ret);
 932		return ret;
 933	}
 934
 935	if (*ireg) {
 936		/*
 937		 * DN_LD_HOST_INT_STATUS and/or UP_LD_HOST_INT_STATUS
 938		 * Clear the interrupt status register and re-enable the
 939		 * interrupt.
 940		 */
 941		BT_DBG("int_status = 0x%x", *ireg);
 942
 943		sdio_writeb(card->func, ~(*ireg) & (DN_LD_HOST_INT_STATUS |
 944						    UP_LD_HOST_INT_STATUS),
 945			    card->reg->host_intstatus, &ret);
 946		if (ret) {
 947			BT_ERR("sdio_writeb: clear int status failed: %d", ret);
 948			return ret;
 949		}
 950	}
 951
 952	return 0;
 953}
 954
 955static void btmrvl_sdio_interrupt(struct sdio_func *func)
 956{
 957	struct btmrvl_private *priv;
 958	struct btmrvl_sdio_card *card;
 959	ulong flags;
 960	u8 ireg = 0;
 961	int ret;
 962
 963	card = sdio_get_drvdata(func);
 964	if (!card || !card->priv) {
 965		BT_ERR("sbi_interrupt(%p) card or priv is NULL, card=%p",
 966		       func, card);
 967		return;
 968	}
 969
 970	priv = card->priv;
 971
 972	if (priv->surprise_removed)
 973		return;
 974
 975	if (card->reg->int_read_to_clear)
 976		ret = btmrvl_sdio_read_to_clear(card, &ireg);
 977	else
 978		ret = btmrvl_sdio_write_to_clear(card, &ireg);
 979
 980	if (ret)
 981		return;
 982
 983	spin_lock_irqsave(&priv->driver_lock, flags);
 984	sdio_ireg |= ireg;
 985	spin_unlock_irqrestore(&priv->driver_lock, flags);
 986
 987	btmrvl_interrupt(priv);
 988}
 989
 990static int btmrvl_sdio_register_dev(struct btmrvl_sdio_card *card)
 991{
 992	struct sdio_func *func;
 993	u8 reg;
 994	int ret;
 995
 996	if (!card || !card->func) {
 997		BT_ERR("Error: card or function is NULL!");
 998		ret = -EINVAL;
 999		goto failed;
1000	}
1001
1002	func = card->func;
1003
1004	sdio_claim_host(func);
1005
1006	ret = sdio_enable_func(func);
1007	if (ret) {
1008		BT_ERR("sdio_enable_func() failed: ret=%d", ret);
1009		ret = -EIO;
1010		goto release_host;
1011	}
1012
1013	ret = sdio_claim_irq(func, btmrvl_sdio_interrupt);
1014	if (ret) {
1015		BT_ERR("sdio_claim_irq failed: ret=%d", ret);
1016		ret = -EIO;
1017		goto disable_func;
1018	}
1019
1020	ret = sdio_set_block_size(card->func, SDIO_BLOCK_SIZE);
1021	if (ret) {
1022		BT_ERR("cannot set SDIO block size");
1023		ret = -EIO;
1024		goto release_irq;
1025	}
1026
1027	reg = sdio_readb(func, card->reg->io_port_0, &ret);
1028	if (ret < 0) {
1029		ret = -EIO;
1030		goto release_irq;
1031	}
1032
1033	card->ioport = reg;
1034
1035	reg = sdio_readb(func, card->reg->io_port_1, &ret);
1036	if (ret < 0) {
1037		ret = -EIO;
1038		goto release_irq;
1039	}
1040
1041	card->ioport |= (reg << 8);
1042
1043	reg = sdio_readb(func, card->reg->io_port_2, &ret);
1044	if (ret < 0) {
1045		ret = -EIO;
1046		goto release_irq;
1047	}
1048
1049	card->ioport |= (reg << 16);
1050
1051	BT_DBG("SDIO FUNC%d IO port: 0x%x", func->num, card->ioport);
1052
1053	if (card->reg->int_read_to_clear) {
1054		reg = sdio_readb(func, card->reg->host_int_rsr, &ret);
1055		if (ret < 0) {
1056			ret = -EIO;
1057			goto release_irq;
1058		}
1059		sdio_writeb(func, reg | 0x3f, card->reg->host_int_rsr, &ret);
1060		if (ret < 0) {
1061			ret = -EIO;
1062			goto release_irq;
1063		}
1064
1065		reg = sdio_readb(func, card->reg->card_misc_cfg, &ret);
1066		if (ret < 0) {
1067			ret = -EIO;
1068			goto release_irq;
1069		}
1070		sdio_writeb(func, reg | 0x10, card->reg->card_misc_cfg, &ret);
1071		if (ret < 0) {
1072			ret = -EIO;
1073			goto release_irq;
1074		}
1075	}
1076
1077	sdio_set_drvdata(func, card);
1078
1079	sdio_release_host(func);
1080
1081	return 0;
1082
1083release_irq:
1084	sdio_release_irq(func);
1085
1086disable_func:
1087	sdio_disable_func(func);
1088
1089release_host:
1090	sdio_release_host(func);
1091
1092failed:
1093	return ret;
1094}
1095
1096static int btmrvl_sdio_unregister_dev(struct btmrvl_sdio_card *card)
1097{
1098	if (card && card->func) {
1099		sdio_claim_host(card->func);
1100		sdio_release_irq(card->func);
1101		sdio_disable_func(card->func);
1102		sdio_release_host(card->func);
1103		sdio_set_drvdata(card->func, NULL);
1104	}
1105
1106	return 0;
1107}
1108
1109static int btmrvl_sdio_enable_host_int(struct btmrvl_sdio_card *card)
1110{
1111	int ret;
1112
1113	if (!card || !card->func)
1114		return -EINVAL;
1115
1116	sdio_claim_host(card->func);
1117
1118	ret = btmrvl_sdio_enable_host_int_mask(card, HIM_ENABLE);
1119
1120	btmrvl_sdio_get_rx_unit(card);
1121
1122	sdio_release_host(card->func);
1123
1124	return ret;
1125}
1126
1127static int btmrvl_sdio_disable_host_int(struct btmrvl_sdio_card *card)
1128{
1129	int ret;
1130
1131	if (!card || !card->func)
1132		return -EINVAL;
1133
1134	sdio_claim_host(card->func);
1135
1136	ret = btmrvl_sdio_disable_host_int_mask(card, HIM_DISABLE);
1137
1138	sdio_release_host(card->func);
1139
1140	return ret;
1141}
1142
1143static int btmrvl_sdio_host_to_card(struct btmrvl_private *priv,
1144				u8 *payload, u16 nb)
1145{
1146	struct btmrvl_sdio_card *card = priv->btmrvl_dev.card;
1147	int ret = 0;
 
1148	int blksz;
1149	int i = 0;
1150	u8 *buf = NULL;
1151	void *tmpbuf = NULL;
1152	int tmpbufsz;
1153
1154	if (!card || !card->func) {
1155		BT_ERR("card or function is NULL!");
1156		return -EINVAL;
1157	}
1158
1159	blksz = DIV_ROUND_UP(nb, SDIO_BLOCK_SIZE) * SDIO_BLOCK_SIZE;
1160
1161	buf = payload;
1162	if ((unsigned long) payload & (BTSDIO_DMA_ALIGN - 1) ||
1163	    nb < blksz) {
1164		tmpbufsz = ALIGN_SZ(blksz, BTSDIO_DMA_ALIGN) +
1165			   BTSDIO_DMA_ALIGN;
1166		tmpbuf = kzalloc(tmpbufsz, GFP_KERNEL);
1167		if (!tmpbuf)
1168			return -ENOMEM;
1169		buf = (u8 *) ALIGN_ADDR(tmpbuf, BTSDIO_DMA_ALIGN);
1170		memcpy(buf, payload, nb);
1171	}
1172
 
 
 
1173	sdio_claim_host(card->func);
1174
1175	do {
1176		/* Transfer data to card */
1177		ret = sdio_writesb(card->func, card->ioport, buf,
1178				   blksz);
1179		if (ret < 0) {
1180			i++;
1181			BT_ERR("i=%d writesb failed: %d", i, ret);
1182			BT_ERR("hex: %*ph", nb, payload);
 
1183			ret = -EIO;
1184			if (i > MAX_WRITE_IOMEM_RETRY)
1185				goto exit;
1186		}
1187	} while (ret);
1188
1189	priv->btmrvl_dev.tx_dnld_rdy = false;
1190
1191exit:
1192	sdio_release_host(card->func);
1193	kfree(tmpbuf);
1194
1195	return ret;
1196}
1197
1198static int btmrvl_sdio_download_fw(struct btmrvl_sdio_card *card)
1199{
1200	int ret;
1201	u8 fws0;
1202	int pollnum = MAX_POLL_TRIES;
1203
1204	if (!card || !card->func) {
1205		BT_ERR("card or function is NULL!");
1206		return -EINVAL;
1207	}
 
1208
1209	if (!btmrvl_sdio_verify_fw_download(card, 1)) {
1210		BT_DBG("Firmware already downloaded!");
1211		return 0;
1212	}
1213
1214	sdio_claim_host(card->func);
1215
1216	/* Check if other function driver is downloading the firmware */
1217	fws0 = sdio_readb(card->func, card->reg->card_fw_status0, &ret);
1218	if (ret) {
1219		BT_ERR("Failed to read FW downloading status!");
1220		ret = -EIO;
1221		goto done;
1222	}
1223	if (fws0) {
1224		BT_DBG("BT not the winner (%#x). Skip FW downloading", fws0);
1225
1226		/* Give other function more time to download the firmware */
1227		pollnum *= 10;
1228	} else {
1229		if (card->helper) {
1230			ret = btmrvl_sdio_download_helper(card);
1231			if (ret) {
1232				BT_ERR("Failed to download helper!");
1233				ret = -EIO;
1234				goto done;
1235			}
1236		}
1237
1238		if (btmrvl_sdio_download_fw_w_helper(card)) {
1239			BT_ERR("Failed to download firmware!");
1240			ret = -EIO;
1241			goto done;
1242		}
1243	}
1244
1245	/*
1246	 * winner or not, with this test the FW synchronizes when the
1247	 * module can continue its initialization
1248	 */
1249	if (btmrvl_sdio_verify_fw_download(card, pollnum)) {
1250		BT_ERR("FW failed to be active in time!");
1251		ret = -ETIMEDOUT;
1252		goto done;
1253	}
1254
 
1255	sdio_release_host(card->func);
1256
1257	return 0;
1258
1259done:
1260	sdio_release_host(card->func);
1261	return ret;
1262}
1263
1264static int btmrvl_sdio_wakeup_fw(struct btmrvl_private *priv)
1265{
1266	struct btmrvl_sdio_card *card = priv->btmrvl_dev.card;
1267	int ret = 0;
1268
1269	if (!card || !card->func) {
1270		BT_ERR("card or function is NULL!");
1271		return -EINVAL;
1272	}
1273
1274	sdio_claim_host(card->func);
1275
1276	sdio_writeb(card->func, HOST_POWER_UP, card->reg->cfg, &ret);
1277
1278	sdio_release_host(card->func);
1279
1280	BT_DBG("wake up firmware");
1281
1282	return ret;
1283}
1284
1285static void btmrvl_sdio_dump_regs(struct btmrvl_private *priv)
1286{
1287	struct btmrvl_sdio_card *card = priv->btmrvl_dev.card;
1288	int ret = 0;
1289	unsigned int reg, reg_start, reg_end;
1290	char buf[256], *ptr;
1291	u8 loop, func, data;
1292	int MAX_LOOP = 2;
1293
1294	btmrvl_sdio_wakeup_fw(priv);
1295	sdio_claim_host(card->func);
1296
1297	for (loop = 0; loop < MAX_LOOP; loop++) {
1298		memset(buf, 0, sizeof(buf));
1299		ptr = buf;
1300
1301		if (loop == 0) {
1302			/* Read the registers of SDIO function0 */
1303			func = loop;
1304			reg_start = 0;
1305			reg_end = 9;
1306		} else {
1307			func = 2;
1308			reg_start = 0;
1309			reg_end = 0x09;
1310		}
1311
1312		ptr += sprintf(ptr, "SDIO Func%d (%#x-%#x): ",
1313			       func, reg_start, reg_end);
1314		for (reg = reg_start; reg <= reg_end; reg++) {
1315			if (func == 0)
1316				data = sdio_f0_readb(card->func, reg, &ret);
1317			else
1318				data = sdio_readb(card->func, reg, &ret);
1319
1320			if (!ret) {
1321				ptr += sprintf(ptr, "%02x ", data);
1322			} else {
1323				ptr += sprintf(ptr, "ERR");
1324				break;
1325			}
1326		}
1327
1328		BT_INFO("%s", buf);
1329	}
1330
1331	sdio_release_host(card->func);
1332}
1333
1334/* This function read/write firmware */
1335static enum
1336rdwr_status btmrvl_sdio_rdwr_firmware(struct btmrvl_private *priv,
1337				      u8 doneflag)
1338{
1339	struct btmrvl_sdio_card *card = priv->btmrvl_dev.card;
1340	int ret, tries;
1341	u8 ctrl_data = 0;
1342
1343	sdio_writeb(card->func, FW_DUMP_HOST_READY, card->reg->fw_dump_ctrl,
1344		    &ret);
1345
1346	if (ret) {
1347		BT_ERR("SDIO write err");
1348		return RDWR_STATUS_FAILURE;
1349	}
1350
1351	for (tries = 0; tries < MAX_POLL_TRIES; tries++) {
1352		ctrl_data = sdio_readb(card->func, card->reg->fw_dump_ctrl,
1353				       &ret);
1354
1355		if (ret) {
1356			BT_ERR("SDIO read err");
1357			return RDWR_STATUS_FAILURE;
1358		}
1359
1360		if (ctrl_data == FW_DUMP_DONE)
1361			break;
1362		if (doneflag && ctrl_data == doneflag)
1363			return RDWR_STATUS_DONE;
1364		if (ctrl_data != FW_DUMP_HOST_READY) {
1365			BT_INFO("The ctrl reg was changed, re-try again!");
1366			sdio_writeb(card->func, FW_DUMP_HOST_READY,
1367				    card->reg->fw_dump_ctrl, &ret);
1368			if (ret) {
1369				BT_ERR("SDIO write err");
1370				return RDWR_STATUS_FAILURE;
1371			}
1372		}
1373		usleep_range(100, 200);
1374	}
1375
1376	if (ctrl_data == FW_DUMP_HOST_READY) {
1377		BT_ERR("Fail to pull ctrl_data");
1378		return RDWR_STATUS_FAILURE;
1379	}
1380
1381	return RDWR_STATUS_SUCCESS;
1382}
1383
1384/* This function dump sdio register and memory data */
1385static void btmrvl_sdio_coredump(struct device *dev)
1386{
1387	struct sdio_func *func = dev_to_sdio_func(dev);
1388	struct btmrvl_sdio_card *card;
1389	struct btmrvl_private *priv;
1390	int ret = 0;
1391	unsigned int reg, reg_start, reg_end;
1392	enum rdwr_status stat;
1393	u8 *dbg_ptr, *end_ptr, *fw_dump_data, *fw_dump_ptr;
1394	u8 dump_num = 0, idx, i, read_reg, doneflag = 0;
1395	u32 memory_size, fw_dump_len = 0;
1396
1397	card = sdio_get_drvdata(func);
1398	priv = card->priv;
1399
1400	/* dump sdio register first */
1401	btmrvl_sdio_dump_regs(priv);
1402
1403	if (!card->supports_fw_dump) {
1404		BT_ERR("Firmware dump not supported for this card!");
1405		return;
1406	}
1407
1408	for (idx = 0; idx < ARRAY_SIZE(mem_type_mapping_tbl); idx++) {
1409		struct memory_type_mapping *entry = &mem_type_mapping_tbl[idx];
1410
1411		if (entry->mem_ptr) {
1412			vfree(entry->mem_ptr);
1413			entry->mem_ptr = NULL;
1414		}
1415		entry->mem_size = 0;
1416	}
1417
1418	btmrvl_sdio_wakeup_fw(priv);
1419	sdio_claim_host(card->func);
1420
1421	BT_INFO("== btmrvl firmware dump start ==");
1422
1423	stat = btmrvl_sdio_rdwr_firmware(priv, doneflag);
1424	if (stat == RDWR_STATUS_FAILURE)
1425		goto done;
1426
1427	reg = card->reg->fw_dump_start;
1428	/* Read the number of the memories which will dump */
1429	dump_num = sdio_readb(card->func, reg, &ret);
1430
1431	if (ret) {
1432		BT_ERR("SDIO read memory length err");
1433		goto done;
1434	}
1435
1436	/* Read the length of every memory which will dump */
1437	for (idx = 0; idx < dump_num; idx++) {
1438		struct memory_type_mapping *entry = &mem_type_mapping_tbl[idx];
1439
1440		stat = btmrvl_sdio_rdwr_firmware(priv, doneflag);
1441		if (stat == RDWR_STATUS_FAILURE)
1442			goto done;
1443
1444		memory_size = 0;
1445		reg = card->reg->fw_dump_start;
1446		for (i = 0; i < 4; i++) {
1447			read_reg = sdio_readb(card->func, reg, &ret);
1448			if (ret) {
1449				BT_ERR("SDIO read err");
1450				goto done;
1451			}
1452			memory_size |= (read_reg << i*8);
1453			reg++;
1454		}
1455
1456		if (memory_size == 0) {
1457			BT_INFO("Firmware dump finished!");
1458			sdio_writeb(card->func, FW_DUMP_READ_DONE,
1459				    card->reg->fw_dump_ctrl, &ret);
1460			if (ret) {
1461				BT_ERR("SDIO Write MEMDUMP_FINISH ERR");
1462				goto done;
1463			}
1464			break;
1465		}
1466
1467		BT_INFO("%s_SIZE=0x%x", entry->mem_name, memory_size);
1468		entry->mem_ptr = vzalloc(memory_size + 1);
1469		entry->mem_size = memory_size;
1470		if (!entry->mem_ptr) {
1471			BT_ERR("Vzalloc %s failed", entry->mem_name);
1472			goto done;
1473		}
1474
1475		fw_dump_len += (strlen("========Start dump ") +
1476				strlen(entry->mem_name) +
1477				strlen("========\n") +
1478				(memory_size + 1) +
1479				strlen("\n========End dump========\n"));
1480
1481		dbg_ptr = entry->mem_ptr;
1482		end_ptr = dbg_ptr + memory_size;
1483
1484		doneflag = entry->done_flag;
1485		BT_INFO("Start %s output, please wait...",
1486			entry->mem_name);
1487
1488		do {
1489			stat = btmrvl_sdio_rdwr_firmware(priv, doneflag);
1490			if (stat == RDWR_STATUS_FAILURE)
1491				goto done;
1492
1493			reg_start = card->reg->fw_dump_start;
1494			reg_end = card->reg->fw_dump_end;
1495			for (reg = reg_start; reg <= reg_end; reg++) {
1496				*dbg_ptr = sdio_readb(card->func, reg, &ret);
1497				if (ret) {
1498					BT_ERR("SDIO read err");
1499					goto done;
1500				}
1501				if (dbg_ptr < end_ptr)
1502					dbg_ptr++;
1503				else
1504					BT_ERR("Allocated buffer not enough");
1505			}
1506
1507			if (stat != RDWR_STATUS_DONE) {
1508				continue;
1509			} else {
1510				BT_INFO("%s done: size=0x%tx",
1511					entry->mem_name,
1512					dbg_ptr - entry->mem_ptr);
1513				break;
1514			}
1515		} while (1);
1516	}
1517
1518	BT_INFO("== btmrvl firmware dump end ==");
1519
1520done:
1521	sdio_release_host(card->func);
1522
1523	if (fw_dump_len == 0)
1524		return;
1525
1526	fw_dump_data = vzalloc(fw_dump_len+1);
1527	if (!fw_dump_data) {
1528		BT_ERR("Vzalloc fw_dump_data fail!");
1529		return;
1530	}
1531	fw_dump_ptr = fw_dump_data;
1532
1533	/* Dump all the memory data into single file, a userspace script will
1534	 * be used to split all the memory data to multiple files
1535	 */
1536	BT_INFO("== btmrvl firmware dump to /sys/class/devcoredump start");
1537	for (idx = 0; idx < dump_num; idx++) {
1538		struct memory_type_mapping *entry = &mem_type_mapping_tbl[idx];
1539
1540		if (entry->mem_ptr) {
1541			strcpy(fw_dump_ptr, "========Start dump ");
1542			fw_dump_ptr += strlen("========Start dump ");
1543
1544			strcpy(fw_dump_ptr, entry->mem_name);
1545			fw_dump_ptr += strlen(entry->mem_name);
1546
1547			strcpy(fw_dump_ptr, "========\n");
1548			fw_dump_ptr += strlen("========\n");
1549
1550			memcpy(fw_dump_ptr, entry->mem_ptr, entry->mem_size);
1551			fw_dump_ptr += entry->mem_size;
1552
1553			strcpy(fw_dump_ptr, "\n========End dump========\n");
1554			fw_dump_ptr += strlen("\n========End dump========\n");
1555
1556			vfree(mem_type_mapping_tbl[idx].mem_ptr);
1557			mem_type_mapping_tbl[idx].mem_ptr = NULL;
1558		}
1559	}
1560
1561	/* fw_dump_data will be free in device coredump release function
1562	 * after 5 min
1563	 */
1564	dev_coredumpv(&card->func->dev, fw_dump_data, fw_dump_len, GFP_KERNEL);
1565	BT_INFO("== btmrvl firmware dump to /sys/class/devcoredump end");
1566}
1567
1568static int btmrvl_sdio_probe(struct sdio_func *func,
1569					const struct sdio_device_id *id)
1570{
1571	int ret = 0;
1572	struct btmrvl_private *priv = NULL;
1573	struct btmrvl_sdio_card *card = NULL;
1574
1575	BT_INFO("vendor=0x%x, device=0x%x, class=%d, fn=%d",
1576			id->vendor, id->device, id->class, func->num);
1577
1578	card = devm_kzalloc(&func->dev, sizeof(*card), GFP_KERNEL);
1579	if (!card)
1580		return -ENOMEM;
 
 
1581
1582	card->func = func;
1583
1584	if (id->driver_data) {
1585		struct btmrvl_sdio_device *data = (void *) id->driver_data;
1586		card->helper = data->helper;
1587		card->firmware = data->firmware;
1588		card->reg = data->reg;
1589		card->sd_blksz_fw_dl = data->sd_blksz_fw_dl;
1590		card->support_pscan_win_report = data->support_pscan_win_report;
1591		card->supports_fw_dump = data->supports_fw_dump;
1592	}
1593
1594	if (btmrvl_sdio_register_dev(card) < 0) {
1595		BT_ERR("Failed to register BT device!");
1596		return -ENODEV;
 
1597	}
1598
1599	/* Disable the interrupts on the card */
1600	btmrvl_sdio_disable_host_int(card);
1601
1602	if (btmrvl_sdio_download_fw(card)) {
1603		BT_ERR("Downloading firmware failed!");
1604		ret = -ENODEV;
1605		goto unreg_dev;
1606	}
1607
 
 
1608	btmrvl_sdio_enable_host_int(card);
1609
1610	/* Device tree node parsing and platform specific configuration*/
1611	btmrvl_sdio_probe_of(&func->dev, card);
1612
1613	priv = btmrvl_add_card(card);
1614	if (!priv) {
1615		BT_ERR("Initializing card failed!");
1616		ret = -ENODEV;
1617		goto disable_host_int;
1618	}
1619
1620	card->priv = priv;
1621
1622	/* Initialize the interface specific function pointers */
1623	priv->hw_host_to_card = btmrvl_sdio_host_to_card;
1624	priv->hw_wakeup_firmware = btmrvl_sdio_wakeup_fw;
1625	priv->hw_process_int_status = btmrvl_sdio_process_int_status;
1626
1627	if (btmrvl_register_hdev(priv)) {
1628		BT_ERR("Register hdev failed!");
1629		ret = -ENODEV;
1630		goto disable_host_int;
1631	}
1632
 
 
 
1633	return 0;
1634
1635disable_host_int:
1636	btmrvl_sdio_disable_host_int(card);
1637unreg_dev:
1638	btmrvl_sdio_unregister_dev(card);
 
 
 
1639	return ret;
1640}
1641
1642static void btmrvl_sdio_remove(struct sdio_func *func)
1643{
1644	struct btmrvl_sdio_card *card;
1645
1646	if (func) {
1647		card = sdio_get_drvdata(func);
1648		if (card) {
1649			/* Send SHUTDOWN command & disable interrupt
1650			 * if user removes the module.
1651			 */
1652			if (user_rmmod) {
1653				btmrvl_send_module_cfg_cmd(card->priv,
1654							MODULE_SHUTDOWN_REQ);
1655				btmrvl_sdio_disable_host_int(card);
1656			}
1657			BT_DBG("unregister dev");
1658			card->priv->surprise_removed = true;
1659			btmrvl_sdio_unregister_dev(card);
1660			btmrvl_remove_card(card->priv);
 
1661		}
1662	}
1663}
1664
1665static int btmrvl_sdio_suspend(struct device *dev)
1666{
1667	struct sdio_func *func = dev_to_sdio_func(dev);
1668	struct btmrvl_sdio_card *card;
1669	struct btmrvl_private *priv;
1670	mmc_pm_flag_t pm_flags;
1671	struct hci_dev *hcidev;
1672
1673	if (func) {
1674		pm_flags = sdio_get_host_pm_caps(func);
1675		BT_DBG("%s: suspend: PM flags = 0x%x", sdio_func_id(func),
1676		       pm_flags);
1677		if (!(pm_flags & MMC_PM_KEEP_POWER)) {
1678			BT_ERR("%s: cannot remain alive while suspended",
1679			       sdio_func_id(func));
1680			return -ENOSYS;
1681		}
1682		card = sdio_get_drvdata(func);
1683		if (!card || !card->priv) {
1684			BT_ERR("card or priv structure is not valid");
1685			return 0;
1686		}
1687	} else {
1688		BT_ERR("sdio_func is not specified");
1689		return 0;
1690	}
1691
1692	/* Enable platform specific wakeup interrupt */
1693	if (card->plt_wake_cfg && card->plt_wake_cfg->irq_bt >= 0) {
1694		card->plt_wake_cfg->wake_by_bt = false;
1695		enable_irq(card->plt_wake_cfg->irq_bt);
1696		enable_irq_wake(card->plt_wake_cfg->irq_bt);
1697	}
1698
1699	priv = card->priv;
1700	priv->adapter->is_suspending = true;
1701	hcidev = priv->btmrvl_dev.hcidev;
1702	BT_DBG("%s: SDIO suspend", hcidev->name);
1703	hci_suspend_dev(hcidev);
1704
1705	if (priv->adapter->hs_state != HS_ACTIVATED) {
1706		if (btmrvl_enable_hs(priv)) {
1707			BT_ERR("HS not activated, suspend failed!");
1708			/* Disable platform specific wakeup interrupt */
1709			if (card->plt_wake_cfg &&
1710			    card->plt_wake_cfg->irq_bt >= 0) {
1711				disable_irq_wake(card->plt_wake_cfg->irq_bt);
1712				disable_irq(card->plt_wake_cfg->irq_bt);
1713			}
1714
1715			priv->adapter->is_suspending = false;
1716			return -EBUSY;
1717		}
1718	}
1719
1720	priv->adapter->is_suspending = false;
1721	priv->adapter->is_suspended = true;
1722
1723	/* We will keep the power when hs enabled successfully */
1724	if (priv->adapter->hs_state == HS_ACTIVATED) {
1725		BT_DBG("suspend with MMC_PM_KEEP_POWER");
1726		return sdio_set_host_pm_flags(func, MMC_PM_KEEP_POWER);
1727	}
1728
1729	BT_DBG("suspend without MMC_PM_KEEP_POWER");
1730	return 0;
1731}
1732
1733static int btmrvl_sdio_resume(struct device *dev)
1734{
1735	struct sdio_func *func = dev_to_sdio_func(dev);
1736	struct btmrvl_sdio_card *card;
1737	struct btmrvl_private *priv;
1738	mmc_pm_flag_t pm_flags;
1739	struct hci_dev *hcidev;
1740
1741	if (func) {
1742		pm_flags = sdio_get_host_pm_caps(func);
1743		BT_DBG("%s: resume: PM flags = 0x%x", sdio_func_id(func),
1744		       pm_flags);
1745		card = sdio_get_drvdata(func);
1746		if (!card || !card->priv) {
1747			BT_ERR("card or priv structure is not valid");
1748			return 0;
1749		}
1750	} else {
1751		BT_ERR("sdio_func is not specified");
1752		return 0;
1753	}
1754	priv = card->priv;
1755
1756	if (!priv->adapter->is_suspended) {
1757		BT_DBG("device already resumed");
1758		return 0;
1759	}
1760
1761	priv->hw_wakeup_firmware(priv);
1762	priv->adapter->hs_state = HS_DEACTIVATED;
1763	hcidev = priv->btmrvl_dev.hcidev;
1764	BT_DBG("%s: HS DEACTIVATED in resume!", hcidev->name);
1765	priv->adapter->is_suspended = false;
1766	BT_DBG("%s: SDIO resume", hcidev->name);
1767	hci_resume_dev(hcidev);
1768
1769	/* Disable platform specific wakeup interrupt */
1770	if (card->plt_wake_cfg && card->plt_wake_cfg->irq_bt >= 0) {
1771		disable_irq_wake(card->plt_wake_cfg->irq_bt);
1772		disable_irq(card->plt_wake_cfg->irq_bt);
1773		if (card->plt_wake_cfg->wake_by_bt)
1774			/* Undo our disable, since interrupt handler already
1775			 * did this.
1776			 */
1777			enable_irq(card->plt_wake_cfg->irq_bt);
1778	}
1779
1780	return 0;
1781}
1782
1783static const struct dev_pm_ops btmrvl_sdio_pm_ops = {
1784	.suspend	= btmrvl_sdio_suspend,
1785	.resume		= btmrvl_sdio_resume,
1786};
1787
1788static struct sdio_driver bt_mrvl_sdio = {
1789	.name		= "btmrvl_sdio",
1790	.id_table	= btmrvl_sdio_ids,
1791	.probe		= btmrvl_sdio_probe,
1792	.remove		= btmrvl_sdio_remove,
1793	.drv = {
1794		.owner = THIS_MODULE,
1795		.coredump = btmrvl_sdio_coredump,
1796		.pm = &btmrvl_sdio_pm_ops,
1797	}
1798};
1799
1800static int __init btmrvl_sdio_init_module(void)
1801{
1802	if (sdio_register_driver(&bt_mrvl_sdio) != 0) {
1803		BT_ERR("SDIO Driver Registration Failed");
1804		return -ENODEV;
1805	}
1806
1807	/* Clear the flag in case user removes the card. */
1808	user_rmmod = 0;
1809
1810	return 0;
1811}
1812
1813static void __exit btmrvl_sdio_exit_module(void)
1814{
1815	/* Set the flag as user is removing this module. */
1816	user_rmmod = 1;
1817
1818	sdio_unregister_driver(&bt_mrvl_sdio);
1819}
1820
1821module_init(btmrvl_sdio_init_module);
1822module_exit(btmrvl_sdio_exit_module);
1823
1824MODULE_AUTHOR("Marvell International Ltd.");
1825MODULE_DESCRIPTION("Marvell BT-over-SDIO driver ver " VERSION);
1826MODULE_VERSION(VERSION);
1827MODULE_LICENSE("GPL v2");
1828MODULE_FIRMWARE("mrvl/sd8688_helper.bin");
1829MODULE_FIRMWARE("mrvl/sd8688.bin");
1830MODULE_FIRMWARE("mrvl/sd8787_uapsta.bin");
1831MODULE_FIRMWARE("mrvl/sd8797_uapsta.bin");
1832MODULE_FIRMWARE("mrvl/sd8887_uapsta.bin");
1833MODULE_FIRMWARE("mrvl/sd8897_uapsta.bin");
1834MODULE_FIRMWARE("mrvl/sd8977_uapsta.bin");
1835MODULE_FIRMWARE("mrvl/sd8987_uapsta.bin");
1836MODULE_FIRMWARE("mrvl/sd8997_uapsta.bin");