drivers/net/wireless/brcm80211/brcmfmac/bcmsdh.c - LeafOS-Devices/android_kernel_samsung_gta4xl - Gitiles

 /*
  * Copyright (c) 2010 Broadcom Corporation
  *
  * Permission to use, copy, modify, and/or distribute this software for any
  * purpose with or without fee is hereby granted, provided that the above
  * copyright notice and this permission notice appear in all copies.
  *
  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
  * SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION
  * OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN
  * CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  */
 /* ****************** SDIO CARD Interface Functions **************************/

 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

 #include <linux/types.h>
 #include <linux/netdevice.h>
 #include <linux/export.h>
 #include <linux/pci.h>
 #include <linux/pci_ids.h>
 #include <linux/sched.h>
 #include <linux/completion.h>
 #include <linux/mmc/sdio.h>
 #include <linux/mmc/sdio_func.h>
 #include <linux/mmc/card.h>

 #include <defs.h>
 #include <brcm_hw_ids.h>
 #include <brcmu_utils.h>
 #include <brcmu_wifi.h>
 #include <soc.h>
 #include "dhd_bus.h"
 #include "dhd_dbg.h"
 #include "sdio_host.h"

 #define SDIOH_API_ACCESS_RETRY_LIMIT	2

 #ifdef CONFIG_BRCMFMAC_SDIO_OOB
 static irqreturn_t brcmf_sdio_irqhandler(int irq, void *dev_id)
 {
 	struct brcmf_sdio_dev *sdiodev = dev_get_drvdata(dev_id);

 	brcmf_dbg(INTR, "oob intr triggered\n");

 	/*
 	 * out-of-band interrupt is level-triggered which won't
 	 * be cleared until dpc
 	 */
 	if (sdiodev->irq_en) {
 		disable_irq_nosync(irq);
 		sdiodev->irq_en = false;
 	}

 	brcmf_sdbrcm_isr(sdiodev->bus);

 	return IRQ_HANDLED;
 }

 int brcmf_sdio_intr_register(struct brcmf_sdio_dev *sdiodev)
 {
 	int ret = 0;
 	u8 data;
 	unsigned long flags;

 	brcmf_dbg(TRACE, "Entering\n");

 	brcmf_dbg(ERROR, "requesting irq %d\n", sdiodev->irq);
 	ret = request_irq(sdiodev->irq, brcmf_sdio_irqhandler,
 			  sdiodev->irq_flags, "brcmf_oob_intr",
 			  &sdiodev->func[1]->card->dev);
 	if (ret != 0)
 		return ret;
 	spin_lock_init(&sdiodev->irq_en_lock);
 	spin_lock_irqsave(&sdiodev->irq_en_lock, flags);
 	sdiodev->irq_en = true;
 	spin_unlock_irqrestore(&sdiodev->irq_en_lock, flags);

 	ret = enable_irq_wake(sdiodev->irq);
 	if (ret != 0)
 		return ret;
 	sdiodev->irq_wake = true;

 	/* must configure SDIO_CCCR_IENx to enable irq */
 	data = brcmf_sdio_regrb(sdiodev, SDIO_CCCR_IENx, &ret);
 	data |= 1 << SDIO_FUNC_1 | 1 << SDIO_FUNC_2 | 1;
 	brcmf_sdio_regwb(sdiodev, SDIO_CCCR_IENx, data, &ret);

 	/* redirect, configure and enable io for interrupt signal */
 	data = SDIO_SEPINT_MASK | SDIO_SEPINT_OE;
 	if (sdiodev->irq_flags & IRQF_TRIGGER_HIGH)
 		data |= SDIO_SEPINT_ACT_HI;
 	brcmf_sdio_regwb(sdiodev, SDIO_CCCR_BRCM_SEPINT, data, &ret);

 	return 0;
 }

 int brcmf_sdio_intr_unregister(struct brcmf_sdio_dev *sdiodev)
 {
 	brcmf_dbg(TRACE, "Entering\n");

 	brcmf_sdio_regwb(sdiodev, SDIO_CCCR_BRCM_SEPINT, 0, NULL);
 	brcmf_sdio_regwb(sdiodev, SDIO_CCCR_IENx, 0, NULL);

 	if (sdiodev->irq_wake) {
 		disable_irq_wake(sdiodev->irq);
 		sdiodev->irq_wake = false;
 	}
 	free_irq(sdiodev->irq, &sdiodev->func[1]->card->dev);
 	sdiodev->irq_en = false;

 	return 0;
 }
 #else		/* CONFIG_BRCMFMAC_SDIO_OOB */
 static void brcmf_sdio_irqhandler(struct sdio_func *func)
 {
 	struct brcmf_sdio_dev *sdiodev = dev_get_drvdata(&func->card->dev);

 	brcmf_dbg(INTR, "ib intr triggered\n");

 	brcmf_sdbrcm_isr(sdiodev->bus);
 }

 /* dummy handler for SDIO function 2 interrupt */
 static void brcmf_sdio_dummy_irqhandler(struct sdio_func *func)
 {
 }

 int brcmf_sdio_intr_register(struct brcmf_sdio_dev *sdiodev)
 {
 	brcmf_dbg(TRACE, "Entering\n");

 	sdio_claim_host(sdiodev->func[1]);
 	sdio_claim_irq(sdiodev->func[1], brcmf_sdio_irqhandler);
 	sdio_claim_irq(sdiodev->func[2], brcmf_sdio_dummy_irqhandler);
 	sdio_release_host(sdiodev->func[1]);

 	return 0;
 }

 int brcmf_sdio_intr_unregister(struct brcmf_sdio_dev *sdiodev)
 {
 	brcmf_dbg(TRACE, "Entering\n");

 	sdio_claim_host(sdiodev->func[1]);
 	sdio_release_irq(sdiodev->func[2]);
 	sdio_release_irq(sdiodev->func[1]);
 	sdio_release_host(sdiodev->func[1]);

 	return 0;
 }
 #endif		/* CONFIG_BRCMFMAC_SDIO_OOB */

 int
 brcmf_sdcard_set_sbaddr_window(struct brcmf_sdio_dev *sdiodev, u32 address)
 {
 	int err = 0, i;
 	u8 addr[3];
 	s32 retry;

 	addr[0] = (address >> 8) & SBSDIO_SBADDRLOW_MASK;
 	addr[1] = (address >> 16) & SBSDIO_SBADDRMID_MASK;
 	addr[2] = (address >> 24) & SBSDIO_SBADDRHIGH_MASK;

 	for (i = 0; i < 3; i++) {
 		retry = 0;
 		do {
 			if (retry)
 				usleep_range(1000, 2000);
 			err = brcmf_sdioh_request_byte(sdiodev, SDIOH_WRITE,
 					SDIO_FUNC_1, SBSDIO_FUNC1_SBADDRLOW + i,
 					&addr[i]);
 		} while (err != 0 && retry++ < SDIOH_API_ACCESS_RETRY_LIMIT);

 		if (err) {
 			brcmf_dbg(ERROR, "failed at addr:0x%0x\n",
 				  SBSDIO_FUNC1_SBADDRLOW + i);
 			break;
 		}
 	}

 	return err;
 }

 int
 brcmf_sdio_regrw_helper(struct brcmf_sdio_dev *sdiodev, u32 addr,
 			void *data, bool write)
 {
 	u8 func_num, reg_size;
 	u32 bar;
 	s32 retry = 0;
 	int ret;

 	/*
 	 * figure out how to read the register based on address range
 	 * 0x00 ~ 0x7FF: function 0 CCCR and FBR
 	 * 0x10000 ~ 0x1FFFF: function 1 miscellaneous registers
 	 * The rest: function 1 silicon backplane core registers
 	 */
 	if ((addr & ~REG_F0_REG_MASK) == 0) {
 		func_num = SDIO_FUNC_0;
 		reg_size = 1;
 	} else if ((addr & ~REG_F1_MISC_MASK) == 0) {
 		func_num = SDIO_FUNC_1;
 		reg_size = 1;
 	} else {
 		func_num = SDIO_FUNC_1;
 		reg_size = 4;

 		/* Set the window for SB core register */
 		bar = addr & ~SBSDIO_SB_OFT_ADDR_MASK;
 		if (bar != sdiodev->sbwad) {
 			ret = brcmf_sdcard_set_sbaddr_window(sdiodev, bar);
 			if (ret != 0) {
 				memset(data, 0xFF, reg_size);
 				return ret;
 			}
 			sdiodev->sbwad = bar;
 		}
 		addr &= SBSDIO_SB_OFT_ADDR_MASK;
 		addr |= SBSDIO_SB_ACCESS_2_4B_FLAG;
 	}

 	do {
 		if (!write)
 			memset(data, 0, reg_size);
 		if (retry)	/* wait for 1 ms till bus get settled down */
 			usleep_range(1000, 2000);
 		if (reg_size == 1)
 			ret = brcmf_sdioh_request_byte(sdiodev, write,
 						       func_num, addr, data);
 		else
 			ret = brcmf_sdioh_request_word(sdiodev, write,
 						       func_num, addr, data, 4);
 	} while (ret != 0 && retry++ < SDIOH_API_ACCESS_RETRY_LIMIT);

 	if (ret != 0)
 		brcmf_dbg(ERROR, "failed with %d\n", ret);

 	return ret;
 }

 u8 brcmf_sdio_regrb(struct brcmf_sdio_dev *sdiodev, u32 addr, int *ret)
 {
 	u8 data;
 	int retval;

 	brcmf_dbg(INFO, "addr:0x%08x\n", addr);
 	sdio_claim_host(sdiodev->func[1]);
 	retval = brcmf_sdio_regrw_helper(sdiodev, addr, &data, false);
 	sdio_release_host(sdiodev->func[1]);
 	brcmf_dbg(INFO, "data:0x%02x\n", data);

 	if (ret)
 		*ret = retval;

 	return data;
 }

 u32 brcmf_sdio_regrl(struct brcmf_sdio_dev *sdiodev, u32 addr, int *ret)
 {
 	u32 data;
 	int retval;

 	brcmf_dbg(INFO, "addr:0x%08x\n", addr);
 	sdio_claim_host(sdiodev->func[1]);
 	retval = brcmf_sdio_regrw_helper(sdiodev, addr, &data, false);
 	sdio_release_host(sdiodev->func[1]);
 	brcmf_dbg(INFO, "data:0x%08x\n", data);

 	if (ret)
 		*ret = retval;

 	return data;
 }

 void brcmf_sdio_regwb(struct brcmf_sdio_dev *sdiodev, u32 addr,
 		      u8 data, int *ret)
 {
 	int retval;

 	brcmf_dbg(INFO, "addr:0x%08x, data:0x%02x\n", addr, data);
 	sdio_claim_host(sdiodev->func[1]);
 	retval = brcmf_sdio_regrw_helper(sdiodev, addr, &data, true);
 	sdio_release_host(sdiodev->func[1]);

 	if (ret)
 		*ret = retval;
 }

 void brcmf_sdio_regwl(struct brcmf_sdio_dev *sdiodev, u32 addr,
 		      u32 data, int *ret)
 {
 	int retval;

 	brcmf_dbg(INFO, "addr:0x%08x, data:0x%08x\n", addr, data);
 	sdio_claim_host(sdiodev->func[1]);
 	retval = brcmf_sdio_regrw_helper(sdiodev, addr, &data, true);
 	sdio_release_host(sdiodev->func[1]);

 	if (ret)
 		*ret = retval;
 }

 static int brcmf_sdcard_recv_prepare(struct brcmf_sdio_dev *sdiodev, uint fn,
 				     uint flags, uint width, u32 *addr)
 {
 	uint bar0 = *addr & ~SBSDIO_SB_OFT_ADDR_MASK;
 	int err = 0;

 	/* Async not implemented yet */
 	if (flags & SDIO_REQ_ASYNC)
 		return -ENOTSUPP;

 	if (bar0 != sdiodev->sbwad) {
 		err = brcmf_sdcard_set_sbaddr_window(sdiodev, bar0);
 		if (err)
 			return err;

 		sdiodev->sbwad = bar0;
 	}

 	*addr &= SBSDIO_SB_OFT_ADDR_MASK;

 	if (width == 4)
 		*addr |= SBSDIO_SB_ACCESS_2_4B_FLAG;

 	return 0;
 }

 int
 brcmf_sdcard_recv_buf(struct brcmf_sdio_dev *sdiodev, u32 addr, uint fn,
 		      uint flags, u8 *buf, uint nbytes)
 {
 	struct sk_buff *mypkt;
 	int err;

 	mypkt = brcmu_pkt_buf_get_skb(nbytes);
 	if (!mypkt) {
 		brcmf_dbg(ERROR, "brcmu_pkt_buf_get_skb failed: len %d\n",
 			  nbytes);
 		return -EIO;
 	}

 	err = brcmf_sdcard_recv_pkt(sdiodev, addr, fn, flags, mypkt);
 	if (!err)
 		memcpy(buf, mypkt->data, nbytes);

 	brcmu_pkt_buf_free_skb(mypkt);
 	return err;
 }

 int
 brcmf_sdcard_recv_pkt(struct brcmf_sdio_dev *sdiodev, u32 addr, uint fn,
 		      uint flags, struct sk_buff *pkt)
 {
 	uint incr_fix;
 	uint width;
 	int err = 0;

 	brcmf_dbg(INFO, "fun = %d, addr = 0x%x, size = %d\n",
 		  fn, addr, pkt->len);

 	sdio_claim_host(sdiodev->func[1]);

 	width = (flags & SDIO_REQ_4BYTE) ? 4 : 2;
 	err = brcmf_sdcard_recv_prepare(sdiodev, fn, flags, width, &addr);
 	if (err)
 		goto done;

 	incr_fix = (flags & SDIO_REQ_FIXED) ? SDIOH_DATA_FIX : SDIOH_DATA_INC;
 	err = brcmf_sdioh_request_buffer(sdiodev, incr_fix, SDIOH_READ,
 					 fn, addr, pkt);

 done:
 	sdio_release_host(sdiodev->func[1]);

 	return err;
 }

 int brcmf_sdcard_recv_chain(struct brcmf_sdio_dev *sdiodev, u32 addr, uint fn,
 			    uint flags, struct sk_buff_head *pktq)
 {
 	uint incr_fix;
 	uint width;
 	int err = 0;

 	brcmf_dbg(INFO, "fun = %d, addr = 0x%x, size = %d\n",
 		  fn, addr, pktq->qlen);

 	sdio_claim_host(sdiodev->func[1]);

 	width = (flags & SDIO_REQ_4BYTE) ? 4 : 2;
 	err = brcmf_sdcard_recv_prepare(sdiodev, fn, flags, width, &addr);
 	if (err)
 		goto done;

 	incr_fix = (flags & SDIO_REQ_FIXED) ? SDIOH_DATA_FIX : SDIOH_DATA_INC;
 	err = brcmf_sdioh_request_chain(sdiodev, incr_fix, SDIOH_READ, fn, addr,
 					pktq);

 done:
 	sdio_release_host(sdiodev->func[1]);

 	return err;
 }

 int
 brcmf_sdcard_send_buf(struct brcmf_sdio_dev *sdiodev, u32 addr, uint fn,
 		      uint flags, u8 *buf, uint nbytes)
 {
 	struct sk_buff *mypkt;
 	int err;

 	mypkt = brcmu_pkt_buf_get_skb(nbytes);
 	if (!mypkt) {
 		brcmf_dbg(ERROR, "brcmu_pkt_buf_get_skb failed: len %d\n",
 			  nbytes);
 		return -EIO;
 	}

 	memcpy(mypkt->data, buf, nbytes);
 	err = brcmf_sdcard_send_pkt(sdiodev, addr, fn, flags, mypkt);

 	brcmu_pkt_buf_free_skb(mypkt);
 	return err;

 }

 int
 brcmf_sdcard_send_pkt(struct brcmf_sdio_dev *sdiodev, u32 addr, uint fn,
 		      uint flags, struct sk_buff *pkt)
 {
 	uint incr_fix;
 	uint width;
 	uint bar0 = addr & ~SBSDIO_SB_OFT_ADDR_MASK;
 	int err = 0;

 	brcmf_dbg(INFO, "fun = %d, addr = 0x%x, size = %d\n",
 		  fn, addr, pkt->len);

 	/* Async not implemented yet */
 	if (flags & SDIO_REQ_ASYNC)
 		return -ENOTSUPP;

 	sdio_claim_host(sdiodev->func[1]);

 	if (bar0 != sdiodev->sbwad) {
 		err = brcmf_sdcard_set_sbaddr_window(sdiodev, bar0);
 		if (err)
 			goto done;

 		sdiodev->sbwad = bar0;
 	}

 	addr &= SBSDIO_SB_OFT_ADDR_MASK;

 	incr_fix = (flags & SDIO_REQ_FIXED) ? SDIOH_DATA_FIX : SDIOH_DATA_INC;
 	width = (flags & SDIO_REQ_4BYTE) ? 4 : 2;
 	if (width == 4)
 		addr |= SBSDIO_SB_ACCESS_2_4B_FLAG;

 	err = brcmf_sdioh_request_buffer(sdiodev, incr_fix, SDIOH_WRITE, fn,
 					 addr, pkt);

 done:
 	sdio_release_host(sdiodev->func[1]);

 	return err;
 }

 int brcmf_sdcard_rwdata(struct brcmf_sdio_dev *sdiodev, uint rw, u32 addr,
 			u8 *buf, uint nbytes)
 {
 	struct sk_buff *mypkt;
 	bool write = rw ? SDIOH_WRITE : SDIOH_READ;
 	int err;

 	addr &= SBSDIO_SB_OFT_ADDR_MASK;
 	addr |= SBSDIO_SB_ACCESS_2_4B_FLAG;

 	mypkt = brcmu_pkt_buf_get_skb(nbytes);
 	if (!mypkt) {
 		brcmf_dbg(ERROR, "brcmu_pkt_buf_get_skb failed: len %d\n",
 			  nbytes);
 		return -EIO;
 	}

 	/* For a write, copy the buffer data into the packet. */
 	if (write)
 		memcpy(mypkt->data, buf, nbytes);

 	err = brcmf_sdioh_request_buffer(sdiodev, SDIOH_DATA_INC, write,
 					 SDIO_FUNC_1, addr, mypkt);

 	/* For a read, copy the packet data back to the buffer. */
 	if (!err && !write)
 		memcpy(buf, mypkt->data, nbytes);

 	brcmu_pkt_buf_free_skb(mypkt);
 	return err;
 }

 int brcmf_sdcard_abort(struct brcmf_sdio_dev *sdiodev, uint fn)
 {
 	char t_func = (char)fn;
 	brcmf_dbg(TRACE, "Enter\n");

 	/* issue abort cmd52 command through F0 */
 	sdio_claim_host(sdiodev->func[1]);
 	brcmf_sdioh_request_byte(sdiodev, SDIOH_WRITE, SDIO_FUNC_0,
 				 SDIO_CCCR_ABORT, &t_func);
 	sdio_release_host(sdiodev->func[1]);

 	brcmf_dbg(TRACE, "Exit\n");
 	return 0;
 }

 int brcmf_sdio_probe(struct brcmf_sdio_dev *sdiodev)
 {
 	u32 regs = 0;
 	int ret = 0;

 	ret = brcmf_sdioh_attach(sdiodev);
 	if (ret)
 		goto out;

 	regs = SI_ENUM_BASE;

 	/* Report the BAR, to fix if needed */
 	sdiodev->sbwad = SI_ENUM_BASE;

 	/* try to attach to the target device */
 	sdiodev->bus = brcmf_sdbrcm_probe(regs, sdiodev);
 	if (!sdiodev->bus) {
 		brcmf_dbg(ERROR, "device attach failed\n");
 		ret = -ENODEV;
 		goto out;
 	}

 out:
 	if (ret)
 		brcmf_sdio_remove(sdiodev);

 	return ret;
 }
 EXPORT_SYMBOL(brcmf_sdio_probe);

 int brcmf_sdio_remove(struct brcmf_sdio_dev *sdiodev)
 {
 	if (sdiodev->bus) {
 		brcmf_sdbrcm_disconnect(sdiodev->bus);
 		sdiodev->bus = NULL;
 	}

 	brcmf_sdioh_detach(sdiodev);

 	sdiodev->sbwad = 0;

 	return 0;
 }
 EXPORT_SYMBOL(brcmf_sdio_remove);

 void brcmf_sdio_wdtmr_enable(struct brcmf_sdio_dev *sdiodev, bool enable)
 {
 	if (enable)
 		brcmf_sdbrcm_wd_timer(sdiodev->bus, BRCMF_WD_POLL_MS);
 	else
 		brcmf_sdbrcm_wd_timer(sdiodev->bus, 0);
 }
	/*
	* Copyright (c) 2010 Broadcom Corporation
	*
	* Permission to use, copy, modify, and/or distribute this software for any
	* purpose with or without fee is hereby granted, provided that the above
	* copyright notice and this permission notice appear in all copies.
	*
	* THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
	* WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
	* MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
	* SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
	* WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION
	* OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN
	* CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
	*/
	/* **************** SDIO CARD Interface Functions ************************/

	#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

	#include <linux/types.h>
	#include <linux/netdevice.h>
	#include <linux/export.h>
	#include <linux/pci.h>
	#include <linux/pci_ids.h>
	#include <linux/sched.h>
	#include <linux/completion.h>
	#include <linux/mmc/sdio.h>
	#include <linux/mmc/sdio_func.h>
	#include <linux/mmc/card.h>

	#include <defs.h>
	#include <brcm_hw_ids.h>
	#include <brcmu_utils.h>
	#include <brcmu_wifi.h>
	#include <soc.h>
	#include "dhd_bus.h"
	#include "dhd_dbg.h"
	#include "sdio_host.h"

	#define SDIOH_API_ACCESS_RETRY_LIMIT 2

	#ifdef CONFIG_BRCMFMAC_SDIO_OOB
	static irqreturn_t brcmf_sdio_irqhandler(int irq, void *dev_id)
	{
	struct brcmf_sdio_dev *sdiodev = dev_get_drvdata(dev_id);

	brcmf_dbg(INTR, "oob intr triggered\n");

	/*
	* out-of-band interrupt is level-triggered which won't
	* be cleared until dpc
	*/
	if (sdiodev->irq_en) {
	disable_irq_nosync(irq);
	sdiodev->irq_en = false;
	}

	brcmf_sdbrcm_isr(sdiodev->bus);

	return IRQ_HANDLED;
	}

	int brcmf_sdio_intr_register(struct brcmf_sdio_dev *sdiodev)
	{
	int ret = 0;
	u8 data;
	unsigned long flags;

	brcmf_dbg(TRACE, "Entering\n");

	brcmf_dbg(ERROR, "requesting irq %d\n", sdiodev->irq);
	ret = request_irq(sdiodev->irq, brcmf_sdio_irqhandler,
	sdiodev->irq_flags, "brcmf_oob_intr",
	&sdiodev->func[1]->card->dev);
	if (ret != 0)
	return ret;
	spin_lock_init(&sdiodev->irq_en_lock);
	spin_lock_irqsave(&sdiodev->irq_en_lock, flags);
	sdiodev->irq_en = true;
	spin_unlock_irqrestore(&sdiodev->irq_en_lock, flags);

	ret = enable_irq_wake(sdiodev->irq);
	if (ret != 0)
	return ret;
	sdiodev->irq_wake = true;

	/* must configure SDIO_CCCR_IENx to enable irq */
	data = brcmf_sdio_regrb(sdiodev, SDIO_CCCR_IENx, &ret);
	data \|= 1 << SDIO_FUNC_1 \| 1 << SDIO_FUNC_2 \| 1;
	brcmf_sdio_regwb(sdiodev, SDIO_CCCR_IENx, data, &ret);

	/* redirect, configure and enable io for interrupt signal */
	data = SDIO_SEPINT_MASK \| SDIO_SEPINT_OE;
	if (sdiodev->irq_flags & IRQF_TRIGGER_HIGH)
	data \|= SDIO_SEPINT_ACT_HI;
	brcmf_sdio_regwb(sdiodev, SDIO_CCCR_BRCM_SEPINT, data, &ret);

	return 0;
	}

	int brcmf_sdio_intr_unregister(struct brcmf_sdio_dev *sdiodev)
	{
	brcmf_dbg(TRACE, "Entering\n");

	brcmf_sdio_regwb(sdiodev, SDIO_CCCR_BRCM_SEPINT, 0, NULL);
	brcmf_sdio_regwb(sdiodev, SDIO_CCCR_IENx, 0, NULL);

	if (sdiodev->irq_wake) {
	disable_irq_wake(sdiodev->irq);
	sdiodev->irq_wake = false;
	}
	free_irq(sdiodev->irq, &sdiodev->func[1]->card->dev);
	sdiodev->irq_en = false;

	return 0;
	}
	#else /* CONFIG_BRCMFMAC_SDIO_OOB */
	static void brcmf_sdio_irqhandler(struct sdio_func *func)
	{
	struct brcmf_sdio_dev *sdiodev = dev_get_drvdata(&func->card->dev);

	brcmf_dbg(INTR, "ib intr triggered\n");

	brcmf_sdbrcm_isr(sdiodev->bus);
	}

	/* dummy handler for SDIO function 2 interrupt */
	static void brcmf_sdio_dummy_irqhandler(struct sdio_func *func)
	{
	}

	int brcmf_sdio_intr_register(struct brcmf_sdio_dev *sdiodev)
	{
	brcmf_dbg(TRACE, "Entering\n");

	sdio_claim_host(sdiodev->func[1]);
	sdio_claim_irq(sdiodev->func[1], brcmf_sdio_irqhandler);
	sdio_claim_irq(sdiodev->func[2], brcmf_sdio_dummy_irqhandler);
	sdio_release_host(sdiodev->func[1]);

	return 0;
	}

	int brcmf_sdio_intr_unregister(struct brcmf_sdio_dev *sdiodev)
	{
	brcmf_dbg(TRACE, "Entering\n");

	sdio_claim_host(sdiodev->func[1]);
	sdio_release_irq(sdiodev->func[2]);
	sdio_release_irq(sdiodev->func[1]);
	sdio_release_host(sdiodev->func[1]);

	return 0;
	}
	#endif /* CONFIG_BRCMFMAC_SDIO_OOB */

	int
	brcmf_sdcard_set_sbaddr_window(struct brcmf_sdio_dev *sdiodev, u32 address)
	{
	int err = 0, i;
	u8 addr[3];
	s32 retry;

	addr[0] = (address >> 8) & SBSDIO_SBADDRLOW_MASK;
	addr[1] = (address >> 16) & SBSDIO_SBADDRMID_MASK;
	addr[2] = (address >> 24) & SBSDIO_SBADDRHIGH_MASK;

	for (i = 0; i < 3; i++) {
	retry = 0;
	do {
	if (retry)
	usleep_range(1000, 2000);
	err = brcmf_sdioh_request_byte(sdiodev, SDIOH_WRITE,
	SDIO_FUNC_1, SBSDIO_FUNC1_SBADDRLOW + i,
	&addr[i]);
	} while (err != 0 && retry++ < SDIOH_API_ACCESS_RETRY_LIMIT);

	if (err) {
	brcmf_dbg(ERROR, "failed at addr:0x%0x\n",
	SBSDIO_FUNC1_SBADDRLOW + i);
	break;
	}
	}

	return err;
	}

	int
	brcmf_sdio_regrw_helper(struct brcmf_sdio_dev *sdiodev, u32 addr,
	void *data, bool write)
	{
	u8 func_num, reg_size;
	u32 bar;
	s32 retry = 0;
	int ret;

	/*
	* figure out how to read the register based on address range
	* 0x00 ~ 0x7FF: function 0 CCCR and FBR
	* 0x10000 ~ 0x1FFFF: function 1 miscellaneous registers
	* The rest: function 1 silicon backplane core registers
	*/
	if ((addr & ~REG_F0_REG_MASK) == 0) {
	func_num = SDIO_FUNC_0;
	reg_size = 1;
	} else if ((addr & ~REG_F1_MISC_MASK) == 0) {
	func_num = SDIO_FUNC_1;
	reg_size = 1;
	} else {
	func_num = SDIO_FUNC_1;
	reg_size = 4;

	/* Set the window for SB core register */
	bar = addr & ~SBSDIO_SB_OFT_ADDR_MASK;
	if (bar != sdiodev->sbwad) {
	ret = brcmf_sdcard_set_sbaddr_window(sdiodev, bar);
	if (ret != 0) {
	memset(data, 0xFF, reg_size);
	return ret;
	}
	sdiodev->sbwad = bar;
	}
	addr &= SBSDIO_SB_OFT_ADDR_MASK;
	addr \|= SBSDIO_SB_ACCESS_2_4B_FLAG;
	}

	do {
	if (!write)
	memset(data, 0, reg_size);
	if (retry) /* wait for 1 ms till bus get settled down */
	usleep_range(1000, 2000);
	if (reg_size == 1)
	ret = brcmf_sdioh_request_byte(sdiodev, write,
	func_num, addr, data);
	else
	ret = brcmf_sdioh_request_word(sdiodev, write,
	func_num, addr, data, 4);
	} while (ret != 0 && retry++ < SDIOH_API_ACCESS_RETRY_LIMIT);

	if (ret != 0)
	brcmf_dbg(ERROR, "failed with %d\n", ret);

	return ret;
	}

	u8 brcmf_sdio_regrb(struct brcmf_sdio_dev sdiodev, u32 addr, int ret)
	{
	u8 data;
	int retval;

	brcmf_dbg(INFO, "addr:0x%08x\n", addr);
	sdio_claim_host(sdiodev->func[1]);
	retval = brcmf_sdio_regrw_helper(sdiodev, addr, &data, false);
	sdio_release_host(sdiodev->func[1]);
	brcmf_dbg(INFO, "data:0x%02x\n", data);

	if (ret)
	*ret = retval;

	return data;
	}

	u32 brcmf_sdio_regrl(struct brcmf_sdio_dev sdiodev, u32 addr, int ret)
	{
	u32 data;
	int retval;

	brcmf_dbg(INFO, "addr:0x%08x\n", addr);
	sdio_claim_host(sdiodev->func[1]);
	retval = brcmf_sdio_regrw_helper(sdiodev, addr, &data, false);
	sdio_release_host(sdiodev->func[1]);
	brcmf_dbg(INFO, "data:0x%08x\n", data);

	if (ret)
	*ret = retval;

	return data;
	}

	void brcmf_sdio_regwb(struct brcmf_sdio_dev *sdiodev, u32 addr,
	u8 data, int *ret)
	{
	int retval;

	brcmf_dbg(INFO, "addr:0x%08x, data:0x%02x\n", addr, data);
	sdio_claim_host(sdiodev->func[1]);
	retval = brcmf_sdio_regrw_helper(sdiodev, addr, &data, true);
	sdio_release_host(sdiodev->func[1]);

	if (ret)
	*ret = retval;
	}

	void brcmf_sdio_regwl(struct brcmf_sdio_dev *sdiodev, u32 addr,
	u32 data, int *ret)
	{
	int retval;

	brcmf_dbg(INFO, "addr:0x%08x, data:0x%08x\n", addr, data);
	sdio_claim_host(sdiodev->func[1]);
	retval = brcmf_sdio_regrw_helper(sdiodev, addr, &data, true);
	sdio_release_host(sdiodev->func[1]);

	if (ret)
	*ret = retval;
	}

	static int brcmf_sdcard_recv_prepare(struct brcmf_sdio_dev *sdiodev, uint fn,
	uint flags, uint width, u32 *addr)
	{
	uint bar0 = *addr & ~SBSDIO_SB_OFT_ADDR_MASK;
	int err = 0;

	/* Async not implemented yet */
	if (flags & SDIO_REQ_ASYNC)
	return -ENOTSUPP;

	if (bar0 != sdiodev->sbwad) {
	err = brcmf_sdcard_set_sbaddr_window(sdiodev, bar0);
	if (err)
	return err;

	sdiodev->sbwad = bar0;
	}

	*addr &= SBSDIO_SB_OFT_ADDR_MASK;

	if (width == 4)
	*addr \|= SBSDIO_SB_ACCESS_2_4B_FLAG;

	return 0;
	}

	int
	brcmf_sdcard_recv_buf(struct brcmf_sdio_dev *sdiodev, u32 addr, uint fn,
	uint flags, u8 *buf, uint nbytes)
	{
	struct sk_buff *mypkt;
	int err;

	mypkt = brcmu_pkt_buf_get_skb(nbytes);
	if (!mypkt) {
	brcmf_dbg(ERROR, "brcmu_pkt_buf_get_skb failed: len %d\n",
	nbytes);
	return -EIO;
	}

	err = brcmf_sdcard_recv_pkt(sdiodev, addr, fn, flags, mypkt);
	if (!err)
	memcpy(buf, mypkt->data, nbytes);

	brcmu_pkt_buf_free_skb(mypkt);
	return err;
	}

	int
	brcmf_sdcard_recv_pkt(struct brcmf_sdio_dev *sdiodev, u32 addr, uint fn,
	uint flags, struct sk_buff *pkt)
	{
	uint incr_fix;
	uint width;
	int err = 0;

	brcmf_dbg(INFO, "fun = %d, addr = 0x%x, size = %d\n",
	fn, addr, pkt->len);

	sdio_claim_host(sdiodev->func[1]);

	width = (flags & SDIO_REQ_4BYTE) ? 4 : 2;
	err = brcmf_sdcard_recv_prepare(sdiodev, fn, flags, width, &addr);
	if (err)
	goto done;

	incr_fix = (flags & SDIO_REQ_FIXED) ? SDIOH_DATA_FIX : SDIOH_DATA_INC;
	err = brcmf_sdioh_request_buffer(sdiodev, incr_fix, SDIOH_READ,
	fn, addr, pkt);

	done:
	sdio_release_host(sdiodev->func[1]);

	return err;
	}

	int brcmf_sdcard_recv_chain(struct brcmf_sdio_dev *sdiodev, u32 addr, uint fn,
	uint flags, struct sk_buff_head *pktq)
	{
	uint incr_fix;
	uint width;
	int err = 0;

	brcmf_dbg(INFO, "fun = %d, addr = 0x%x, size = %d\n",
	fn, addr, pktq->qlen);

	sdio_claim_host(sdiodev->func[1]);

	width = (flags & SDIO_REQ_4BYTE) ? 4 : 2;
	err = brcmf_sdcard_recv_prepare(sdiodev, fn, flags, width, &addr);
	if (err)
	goto done;

	incr_fix = (flags & SDIO_REQ_FIXED) ? SDIOH_DATA_FIX : SDIOH_DATA_INC;
	err = brcmf_sdioh_request_chain(sdiodev, incr_fix, SDIOH_READ, fn, addr,
	pktq);

	done:
	sdio_release_host(sdiodev->func[1]);

	return err;
	}

	int
	brcmf_sdcard_send_buf(struct brcmf_sdio_dev *sdiodev, u32 addr, uint fn,
	uint flags, u8 *buf, uint nbytes)
	{
	struct sk_buff *mypkt;
	int err;

	mypkt = brcmu_pkt_buf_get_skb(nbytes);
	if (!mypkt) {
	brcmf_dbg(ERROR, "brcmu_pkt_buf_get_skb failed: len %d\n",
	nbytes);
	return -EIO;
	}

	memcpy(mypkt->data, buf, nbytes);
	err = brcmf_sdcard_send_pkt(sdiodev, addr, fn, flags, mypkt);

	brcmu_pkt_buf_free_skb(mypkt);
	return err;

	}

	int
	brcmf_sdcard_send_pkt(struct brcmf_sdio_dev *sdiodev, u32 addr, uint fn,
	uint flags, struct sk_buff *pkt)
	{
	uint incr_fix;
	uint width;
	uint bar0 = addr & ~SBSDIO_SB_OFT_ADDR_MASK;
	int err = 0;

	brcmf_dbg(INFO, "fun = %d, addr = 0x%x, size = %d\n",
	fn, addr, pkt->len);

	/* Async not implemented yet */
	if (flags & SDIO_REQ_ASYNC)
	return -ENOTSUPP;

	sdio_claim_host(sdiodev->func[1]);

	if (bar0 != sdiodev->sbwad) {
	err = brcmf_sdcard_set_sbaddr_window(sdiodev, bar0);
	if (err)
	goto done;

	sdiodev->sbwad = bar0;
	}

	addr &= SBSDIO_SB_OFT_ADDR_MASK;

	incr_fix = (flags & SDIO_REQ_FIXED) ? SDIOH_DATA_FIX : SDIOH_DATA_INC;
	width = (flags & SDIO_REQ_4BYTE) ? 4 : 2;
	if (width == 4)
	addr \|= SBSDIO_SB_ACCESS_2_4B_FLAG;

	err = brcmf_sdioh_request_buffer(sdiodev, incr_fix, SDIOH_WRITE, fn,
	addr, pkt);

	done:
	sdio_release_host(sdiodev->func[1]);

	return err;
	}

	int brcmf_sdcard_rwdata(struct brcmf_sdio_dev *sdiodev, uint rw, u32 addr,
	u8 *buf, uint nbytes)
	{
	struct sk_buff *mypkt;
	bool write = rw ? SDIOH_WRITE : SDIOH_READ;
	int err;

	addr &= SBSDIO_SB_OFT_ADDR_MASK;
	addr \|= SBSDIO_SB_ACCESS_2_4B_FLAG;

	mypkt = brcmu_pkt_buf_get_skb(nbytes);
	if (!mypkt) {
	brcmf_dbg(ERROR, "brcmu_pkt_buf_get_skb failed: len %d\n",
	nbytes);
	return -EIO;
	}

	/* For a write, copy the buffer data into the packet. */
	if (write)
	memcpy(mypkt->data, buf, nbytes);

	err = brcmf_sdioh_request_buffer(sdiodev, SDIOH_DATA_INC, write,
	SDIO_FUNC_1, addr, mypkt);

	/* For a read, copy the packet data back to the buffer. */
	if (!err && !write)
	memcpy(buf, mypkt->data, nbytes);

	brcmu_pkt_buf_free_skb(mypkt);
	return err;
	}

	int brcmf_sdcard_abort(struct brcmf_sdio_dev *sdiodev, uint fn)
	{
	char t_func = (char)fn;
	brcmf_dbg(TRACE, "Enter\n");

	/* issue abort cmd52 command through F0 */
	sdio_claim_host(sdiodev->func[1]);
	brcmf_sdioh_request_byte(sdiodev, SDIOH_WRITE, SDIO_FUNC_0,
	SDIO_CCCR_ABORT, &t_func);
	sdio_release_host(sdiodev->func[1]);

	brcmf_dbg(TRACE, "Exit\n");
	return 0;
	}

	int brcmf_sdio_probe(struct brcmf_sdio_dev *sdiodev)
	{
	u32 regs = 0;
	int ret = 0;

	ret = brcmf_sdioh_attach(sdiodev);
	if (ret)
	goto out;

	regs = SI_ENUM_BASE;

	/* Report the BAR, to fix if needed */
	sdiodev->sbwad = SI_ENUM_BASE;

	/* try to attach to the target device */
	sdiodev->bus = brcmf_sdbrcm_probe(regs, sdiodev);
	if (!sdiodev->bus) {
	brcmf_dbg(ERROR, "device attach failed\n");
	ret = -ENODEV;
	goto out;
	}

	out:
	if (ret)
	brcmf_sdio_remove(sdiodev);

	return ret;
	}
	EXPORT_SYMBOL(brcmf_sdio_probe);

	int brcmf_sdio_remove(struct brcmf_sdio_dev *sdiodev)
	{
	if (sdiodev->bus) {
	brcmf_sdbrcm_disconnect(sdiodev->bus);
	sdiodev->bus = NULL;
	}

	brcmf_sdioh_detach(sdiodev);

	sdiodev->sbwad = 0;

	return 0;
	}
	EXPORT_SYMBOL(brcmf_sdio_remove);

	void brcmf_sdio_wdtmr_enable(struct brcmf_sdio_dev *sdiodev, bool enable)
	{
	if (enable)
	brcmf_sdbrcm_wd_timer(sdiodev->bus, BRCMF_WD_POLL_MS);
	else
	brcmf_sdbrcm_wd_timer(sdiodev->bus, 0);
	}