[deliverable/linux.git] / drivers / net / wireless / brcm80211 / brcmfmac / bcmsdh_sdmmc.c

/*
 * 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.
 */
#include <linux/types.h>
#include <linux/netdevice.h>
#include <linux/mmc/sdio.h>
#include <linux/mmc/core.h>
#include <linux/mmc/sdio_func.h>
#include <linux/mmc/sdio_ids.h>
#include <linux/mmc/card.h>
#include <linux/suspend.h>
#include <linux/errno.h>
#include <linux/sched.h>	/* request_irq() */
#include <linux/module.h>
#include <net/cfg80211.h>

#include <defs.h>
#include <brcm_hw_ids.h>
#include <brcmu_utils.h>
#include <brcmu_wifi.h>
#include "sdio_host.h"
#include "dhd.h"
#include "dhd_dbg.h"
#include "wl_cfg80211.h"

#define SDIO_VENDOR_ID_BROADCOM		0x02d0

#define DMA_ALIGN_MASK	0x03

#define SDIO_DEVICE_ID_BROADCOM_4329	0x4329

#define SDIO_FUNC1_BLOCKSIZE		64
#define SDIO_FUNC2_BLOCKSIZE		512

/* devices we support, null terminated */
static const struct sdio_device_id brcmf_sdmmc_ids[] = {
	{SDIO_DEVICE(SDIO_VENDOR_ID_BROADCOM, SDIO_DEVICE_ID_BROADCOM_4329)},
	{ /* end: all zeroes */ },
};
MODULE_DEVICE_TABLE(sdio, brcmf_sdmmc_ids);

static bool
brcmf_pm_resume_error(struct brcmf_sdio_dev *sdiodev)
{
	bool is_err = false;
#ifdef CONFIG_PM_SLEEP
	is_err = atomic_read(&sdiodev->suspend);
#endif
	return is_err;
}

static void
brcmf_pm_resume_wait(struct brcmf_sdio_dev *sdiodev, wait_queue_head_t *wq)
{
#ifdef CONFIG_PM_SLEEP
	int retry = 0;
	while (atomic_read(&sdiodev->suspend) && retry++ != 30)
		wait_event_timeout(*wq, false, HZ/100);
#endif
}

static inline int brcmf_sdioh_f0_write_byte(struct brcmf_sdio_dev *sdiodev,
					    uint regaddr, u8 *byte)
{
	struct sdio_func *sdfunc = sdiodev->func[0];
	int err_ret;

	/*
	 * Can only directly write to some F0 registers.
	 * Handle F2 enable/disable and Abort command
	 * as a special case.
	 */
	if (regaddr == SDIO_CCCR_IOEx) {
		sdfunc = sdiodev->func[2];
		if (sdfunc) {
			sdio_claim_host(sdfunc);
			if (*byte & SDIO_FUNC_ENABLE_2) {
				/* Enable Function 2 */
				err_ret = sdio_enable_func(sdfunc);
				if (err_ret)
					brcmf_dbg(ERROR,
						  "enable F2 failed:%d\n",
						  err_ret);
			} else {
				/* Disable Function 2 */
				err_ret = sdio_disable_func(sdfunc);
				if (err_ret)
					brcmf_dbg(ERROR,
						  "Disable F2 failed:%d\n",
						  err_ret);
			}
			sdio_release_host(sdfunc);
		}
	} else if (regaddr == SDIO_CCCR_ABORT) {
		sdio_claim_host(sdfunc);
		sdio_writeb(sdfunc, *byte, regaddr, &err_ret);
		sdio_release_host(sdfunc);
	} else if (regaddr < 0xF0) {
		brcmf_dbg(ERROR, "F0 Wr:0x%02x: write disallowed\n", regaddr);
		err_ret = -EPERM;
	} else {
		sdio_claim_host(sdfunc);
		sdio_f0_writeb(sdfunc, *byte, regaddr, &err_ret);
		sdio_release_host(sdfunc);
	}

	return err_ret;
}

int brcmf_sdioh_request_byte(struct brcmf_sdio_dev *sdiodev, uint rw, uint func,
			     uint regaddr, u8 *byte)
{
	int err_ret;

	brcmf_dbg(INFO, "rw=%d, func=%d, addr=0x%05x\n", rw, func, regaddr);

	brcmf_pm_resume_wait(sdiodev, &sdiodev->request_byte_wait);
	if (brcmf_pm_resume_error(sdiodev))
		return -EIO;

	if (rw && func == 0) {
		/* handle F0 separately */
		err_ret = brcmf_sdioh_f0_write_byte(sdiodev, regaddr, byte);
	} else {
		sdio_claim_host(sdiodev->func[func]);
		if (rw) /* CMD52 Write */
			sdio_writeb(sdiodev->func[func], *byte, regaddr,
				    &err_ret);
		else if (func == 0) {
			*byte = sdio_f0_readb(sdiodev->func[func], regaddr,
					      &err_ret);
		} else {
			*byte = sdio_readb(sdiodev->func[func], regaddr,
					   &err_ret);
		}
		sdio_release_host(sdiodev->func[func]);
	}

	if (err_ret)
		brcmf_dbg(ERROR, "Failed to %s byte F%d:@0x%05x=%02x, Err: %d\n",
			  rw ? "write" : "read", func, regaddr, *byte, err_ret);

	return err_ret;
}

int brcmf_sdioh_request_word(struct brcmf_sdio_dev *sdiodev,
			     uint rw, uint func, uint addr, u32 *word,
			     uint nbytes)
{
	int err_ret = -EIO;

	if (func == 0) {
		brcmf_dbg(ERROR, "Only CMD52 allowed to F0\n");
		return -EINVAL;
	}

	brcmf_dbg(INFO, "rw=%d, func=%d, addr=0x%05x, nbytes=%d\n",
		  rw, func, addr, nbytes);

	brcmf_pm_resume_wait(sdiodev, &sdiodev->request_word_wait);
	if (brcmf_pm_resume_error(sdiodev))
		return -EIO;
	/* Claim host controller */
	sdio_claim_host(sdiodev->func[func]);

	if (rw) {		/* CMD52 Write */
		if (nbytes == 4)
			sdio_writel(sdiodev->func[func], *word, addr,
				    &err_ret);
		else if (nbytes == 2)
			sdio_writew(sdiodev->func[func], (*word & 0xFFFF),
				    addr, &err_ret);
		else
			brcmf_dbg(ERROR, "Invalid nbytes: %d\n", nbytes);
	} else {		/* CMD52 Read */
		if (nbytes == 4)
			*word = sdio_readl(sdiodev->func[func], addr, &err_ret);
		else if (nbytes == 2)
			*word = sdio_readw(sdiodev->func[func], addr,
					   &err_ret) & 0xFFFF;
		else
			brcmf_dbg(ERROR, "Invalid nbytes: %d\n", nbytes);
	}

	/* Release host controller */
	sdio_release_host(sdiodev->func[func]);

	if (err_ret)
		brcmf_dbg(ERROR, "Failed to %s word, Err: 0x%08x\n",
			  rw ? "write" : "read", err_ret);

	return err_ret;
}

/* precondition: host controller is claimed */
static int
brcmf_sdioh_request_data(struct brcmf_sdio_dev *sdiodev, uint write, bool fifo,
			 uint func, uint addr, struct sk_buff *pkt, uint pktlen)
{
	int err_ret = 0;

	if ((write) && (!fifo)) {
		err_ret = sdio_memcpy_toio(sdiodev->func[func], addr,
					   ((u8 *) (pkt->data)), pktlen);
	} else if (write) {
		err_ret = sdio_memcpy_toio(sdiodev->func[func], addr,
					   ((u8 *) (pkt->data)), pktlen);
	} else if (fifo) {
		err_ret = sdio_readsb(sdiodev->func[func],
				      ((u8 *) (pkt->data)), addr, pktlen);
	} else {
		err_ret = sdio_memcpy_fromio(sdiodev->func[func],
					     ((u8 *) (pkt->data)),
					     addr, pktlen);
	}

	return err_ret;
}

static int
brcmf_sdioh_request_packet(struct brcmf_sdio_dev *sdiodev, uint fix_inc,
			   uint write, uint func, uint addr,
			   struct sk_buff *pkt)
{
	bool fifo = (fix_inc == SDIOH_DATA_FIX);
	int err_ret = 0;
	uint pkt_len = pkt->len;

	brcmf_dbg(TRACE, "Enter\n");

	brcmf_pm_resume_wait(sdiodev, &sdiodev->request_packet_wait);
	if (brcmf_pm_resume_error(sdiodev))
		return -EIO;

	/* Claim host controller */
	sdio_claim_host(sdiodev->func[func]);

	pkt_len += 3;
	pkt_len &= 0xFFFFFFFC;

	err_ret = brcmf_sdioh_request_data(sdiodev, write, fifo, func,
					   addr, pkt, pkt_len);
	if (err_ret) {
		brcmf_dbg(ERROR, "%s FAILED %p, addr=0x%05x, pkt_len=%d, ERR=0x%08x\n",
			  write ? "TX" : "RX", pkt, addr, pkt_len, err_ret);
	} else {
		brcmf_dbg(TRACE, "%s xfr'd %p, addr=0x%05x, len=%d\n",
			  write ? "TX" : "RX", pkt, addr, pkt_len);
	}

	/* Release host controller */
	sdio_release_host(sdiodev->func[func]);

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

int
brcmf_sdioh_request_chain(struct brcmf_sdio_dev *sdiodev, uint fix_inc,
			  uint write, uint func, uint addr,
			  struct sk_buff_head *pktq)
{
	bool fifo = (fix_inc == SDIOH_DATA_FIX);
	u32 SGCount = 0;
	int err_ret = 0;

	struct sk_buff *pkt;

	brcmf_dbg(TRACE, "Enter\n");

	brcmf_pm_resume_wait(sdiodev, &sdiodev->request_packet_wait);
	if (brcmf_pm_resume_error(sdiodev))
		return -EIO;

	/* Claim host controller */
	sdio_claim_host(sdiodev->func[func]);

	skb_queue_walk(pktq, pkt) {
		uint pkt_len = pkt->len;
		pkt_len += 3;
		pkt_len &= 0xFFFFFFFC;

		err_ret = brcmf_sdioh_request_data(sdiodev, write, fifo, func,
						   addr, pkt, pkt_len);
		if (err_ret) {
			brcmf_dbg(ERROR, "%s FAILED %p[%d], addr=0x%05x, pkt_len=%d, ERR=0x%08x\n",
				  write ? "TX" : "RX", pkt, SGCount, addr,
				  pkt_len, err_ret);
		} else {
			brcmf_dbg(TRACE, "%s xfr'd %p[%d], addr=0x%05x, len=%d\n",
				  write ? "TX" : "RX", pkt, SGCount, addr,
				  pkt_len);
		}
		if (!fifo)
			addr += pkt_len;

		SGCount++;
	}

	/* Release host controller */
	sdio_release_host(sdiodev->func[func]);

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

/*
 * This function takes a buffer or packet, and fixes everything up
 * so that in the end, a DMA-able packet is created.
 *
 * A buffer does not have an associated packet pointer,
 * and may or may not be aligned.
 * A packet may consist of a single packet, or a packet chain.
 * If it is a packet chain, then all the packets in the chain
 * must be properly aligned.
 *
 * If the packet data is not aligned, then there may only be
 * one packet, and in this case,  it is copied to a new
 * aligned packet.
 *
 */
int brcmf_sdioh_request_buffer(struct brcmf_sdio_dev *sdiodev,
			       uint fix_inc, uint write, uint func, uint addr,
			       uint reg_width, uint buflen_u, u8 *buffer,
			       struct sk_buff *pkt)
{
	int Status;
	struct sk_buff *mypkt = NULL;

	brcmf_dbg(TRACE, "Enter\n");

	brcmf_pm_resume_wait(sdiodev, &sdiodev->request_buffer_wait);
	if (brcmf_pm_resume_error(sdiodev))
		return -EIO;
	/* Case 1: we don't have a packet. */
	if (pkt == NULL) {
		brcmf_dbg(DATA, "Creating new %s Packet, len=%d\n",
			  write ? "TX" : "RX", buflen_u);
		mypkt = brcmu_pkt_buf_get_skb(buflen_u);
		if (!mypkt) {
			brcmf_dbg(ERROR, "brcmu_pkt_buf_get_skb failed: len %d\n",
				  buflen_u);
			return -EIO;
		}

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

		Status = brcmf_sdioh_request_packet(sdiodev, fix_inc, write,
						    func, addr, mypkt);

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

		brcmu_pkt_buf_free_skb(mypkt);
	} else if (((ulong) (pkt->data) & DMA_ALIGN_MASK) != 0) {
		/*
		 * Case 2: We have a packet, but it is unaligned.
		 * In this case, we cannot have a chain (pkt->next == NULL)
		 */
		brcmf_dbg(DATA, "Creating aligned %s Packet, len=%d\n",
			  write ? "TX" : "RX", pkt->len);
		mypkt = brcmu_pkt_buf_get_skb(pkt->len);
		if (!mypkt) {
			brcmf_dbg(ERROR, "brcmu_pkt_buf_get_skb failed: len %d\n",
				  pkt->len);
			return -EIO;
		}

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

		Status = brcmf_sdioh_request_packet(sdiodev, fix_inc, write,
						    func, addr, mypkt);

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

		brcmu_pkt_buf_free_skb(mypkt);
	} else {		/* case 3: We have a packet and
				 it is aligned. */
		brcmf_dbg(DATA, "Aligned %s Packet, direct DMA\n",
			  write ? "Tx" : "Rx");
		Status = brcmf_sdioh_request_packet(sdiodev, fix_inc, write,
						    func, addr, pkt);
	}

	return Status;
}

/* Read client card reg */
static int
brcmf_sdioh_card_regread(struct brcmf_sdio_dev *sdiodev, int func, u32 regaddr,
			 int regsize, u32 *data)
{

	if ((func == 0) || (regsize == 1)) {
		u8 temp = 0;

		brcmf_sdioh_request_byte(sdiodev, SDIOH_READ, func, regaddr,
					 &temp);
		*data = temp;
		*data &= 0xff;
		brcmf_dbg(DATA, "byte read data=0x%02x\n", *data);
	} else {
		brcmf_sdioh_request_word(sdiodev, SDIOH_READ, func, regaddr,
					 data, regsize);
		if (regsize == 2)
			*data &= 0xffff;

		brcmf_dbg(DATA, "word read data=0x%08x\n", *data);
	}

	return SUCCESS;
}

static int brcmf_sdioh_get_cisaddr(struct brcmf_sdio_dev *sdiodev, u32 regaddr)
{
	/* read 24 bits and return valid 17 bit addr */
	int i;
	u32 scratch, regdata;
	__le32 scratch_le;
	u8 *ptr = (u8 *)&scratch_le;

	for (i = 0; i < 3; i++) {
		if ((brcmf_sdioh_card_regread(sdiodev, 0, regaddr, 1,
				&regdata)) != SUCCESS)
			brcmf_dbg(ERROR, "Can't read!\n");

		*ptr++ = (u8) regdata;
		regaddr++;
	}

	/* Only the lower 17-bits are valid */
	scratch = le32_to_cpu(scratch_le);
	scratch &= 0x0001FFFF;
	return scratch;
}

static int brcmf_sdioh_enablefuncs(struct brcmf_sdio_dev *sdiodev)
{
	int err_ret;
	u32 fbraddr;
	u8 func;

	brcmf_dbg(TRACE, "\n");

	/* Get the Card's common CIS address */
	sdiodev->func_cis_ptr[0] = brcmf_sdioh_get_cisaddr(sdiodev,
							   SDIO_CCCR_CIS);
	brcmf_dbg(INFO, "Card's Common CIS Ptr = 0x%x\n",
		  sdiodev->func_cis_ptr[0]);

	/* Get the Card's function CIS (for each function) */
	for (fbraddr = SDIO_FBR_BASE(1), func = 1;
	     func <= sdiodev->num_funcs; func++, fbraddr += SDIOD_FBR_SIZE) {
		sdiodev->func_cis_ptr[func] =
		    brcmf_sdioh_get_cisaddr(sdiodev, SDIO_FBR_CIS + fbraddr);
		brcmf_dbg(INFO, "Function %d CIS Ptr = 0x%x\n",
			  func, sdiodev->func_cis_ptr[func]);
	}

	/* Enable Function 1 */
	sdio_claim_host(sdiodev->func[1]);
	err_ret = sdio_enable_func(sdiodev->func[1]);
	sdio_release_host(sdiodev->func[1]);
	if (err_ret)
		brcmf_dbg(ERROR, "Failed to enable F1 Err: 0x%08x\n", err_ret);

	return false;
}

/*
 *	Public entry points & extern's
 */
int brcmf_sdioh_attach(struct brcmf_sdio_dev *sdiodev)
{
	int err_ret = 0;

	brcmf_dbg(TRACE, "\n");

	sdiodev->num_funcs = 2;

	sdio_claim_host(sdiodev->func[1]);
	err_ret = sdio_set_block_size(sdiodev->func[1], SDIO_FUNC1_BLOCKSIZE);
	sdio_release_host(sdiodev->func[1]);
	if (err_ret) {
		brcmf_dbg(ERROR, "Failed to set F1 blocksize\n");
		goto out;
	}

	sdio_claim_host(sdiodev->func[2]);
	err_ret = sdio_set_block_size(sdiodev->func[2], SDIO_FUNC2_BLOCKSIZE);
	sdio_release_host(sdiodev->func[2]);
	if (err_ret) {
		brcmf_dbg(ERROR, "Failed to set F2 blocksize\n");
		goto out;
	}

	brcmf_sdioh_enablefuncs(sdiodev);

out:
	brcmf_dbg(TRACE, "Done\n");
	return err_ret;
}

void brcmf_sdioh_detach(struct brcmf_sdio_dev *sdiodev)
{
	brcmf_dbg(TRACE, "\n");

	/* Disable Function 2 */
	sdio_claim_host(sdiodev->func[2]);
	sdio_disable_func(sdiodev->func[2]);
	sdio_release_host(sdiodev->func[2]);

	/* Disable Function 1 */
	sdio_claim_host(sdiodev->func[1]);
	sdio_disable_func(sdiodev->func[1]);
	sdio_release_host(sdiodev->func[1]);

}

static int brcmf_ops_sdio_probe(struct sdio_func *func,
			      const struct sdio_device_id *id)
{
	int ret = 0;
	struct brcmf_sdio_dev *sdiodev;
	brcmf_dbg(TRACE, "Enter\n");
	brcmf_dbg(TRACE, "func->class=%x\n", func->class);
	brcmf_dbg(TRACE, "sdio_vendor: 0x%04x\n", func->vendor);
	brcmf_dbg(TRACE, "sdio_device: 0x%04x\n", func->device);
	brcmf_dbg(TRACE, "Function#: 0x%04x\n", func->num);

	if (func->num == 1) {
		if (dev_get_drvdata(&func->card->dev)) {
			brcmf_dbg(ERROR, "card private drvdata occupied\n");
			return -ENXIO;
		}
		sdiodev = kzalloc(sizeof(struct brcmf_sdio_dev), GFP_KERNEL);
		if (!sdiodev)
			return -ENOMEM;
		sdiodev->func[0] = func->card->sdio_func[0];
		sdiodev->func[1] = func;
		dev_set_drvdata(&func->card->dev, sdiodev);

		atomic_set(&sdiodev->suspend, false);
		init_waitqueue_head(&sdiodev->request_byte_wait);
		init_waitqueue_head(&sdiodev->request_word_wait);
		init_waitqueue_head(&sdiodev->request_packet_wait);
		init_waitqueue_head(&sdiodev->request_buffer_wait);
	}

	if (func->num == 2) {
		sdiodev = dev_get_drvdata(&func->card->dev);
		if ((!sdiodev) || (sdiodev->func[1]->card != func->card))
			return -ENODEV;
		sdiodev->func[2] = func;

		brcmf_dbg(TRACE, "F2 found, calling brcmf_sdio_probe...\n");
		ret = brcmf_sdio_probe(sdiodev);
	}

	return ret;
}

static void brcmf_ops_sdio_remove(struct sdio_func *func)
{
	struct brcmf_sdio_dev *sdiodev;
	brcmf_dbg(TRACE, "Enter\n");
	brcmf_dbg(INFO, "func->class=%x\n", func->class);
	brcmf_dbg(INFO, "sdio_vendor: 0x%04x\n", func->vendor);
	brcmf_dbg(INFO, "sdio_device: 0x%04x\n", func->device);
	brcmf_dbg(INFO, "Function#: 0x%04x\n", func->num);

	if (func->num == 2) {
		sdiodev = dev_get_drvdata(&func->card->dev);
		brcmf_dbg(TRACE, "F2 found, calling brcmf_sdio_remove...\n");
		brcmf_sdio_remove(sdiodev);
		dev_set_drvdata(&func->card->dev, NULL);
		kfree(sdiodev);
	}
}

#ifdef CONFIG_PM_SLEEP
static int brcmf_sdio_suspend(struct device *dev)
{
	mmc_pm_flag_t sdio_flags;
	struct brcmf_sdio_dev *sdiodev;
	struct sdio_func *func = dev_to_sdio_func(dev);
	int ret = 0;

	brcmf_dbg(TRACE, "\n");

	sdiodev = dev_get_drvdata(&func->card->dev);

	atomic_set(&sdiodev->suspend, true);

	sdio_flags = sdio_get_host_pm_caps(sdiodev->func[1]);
	if (!(sdio_flags & MMC_PM_KEEP_POWER)) {
		brcmf_dbg(ERROR, "Host can't keep power while suspended\n");
		return -EINVAL;
	}

	ret = sdio_set_host_pm_flags(sdiodev->func[1], MMC_PM_KEEP_POWER);
	if (ret) {
		brcmf_dbg(ERROR, "Failed to set pm_flags\n");
		return ret;
	}

	brcmf_sdio_wdtmr_enable(sdiodev, false);

	return ret;
}

static int brcmf_sdio_resume(struct device *dev)
{
	struct brcmf_sdio_dev *sdiodev;
	struct sdio_func *func = dev_to_sdio_func(dev);

	sdiodev = dev_get_drvdata(&func->card->dev);
	brcmf_sdio_wdtmr_enable(sdiodev, true);
	atomic_set(&sdiodev->suspend, false);
	return 0;
}

static const struct dev_pm_ops brcmf_sdio_pm_ops = {
	.suspend	= brcmf_sdio_suspend,
	.resume		= brcmf_sdio_resume,
};
#endif	/* CONFIG_PM_SLEEP */

static struct sdio_driver brcmf_sdmmc_driver = {
	.probe = brcmf_ops_sdio_probe,
	.remove = brcmf_ops_sdio_remove,
	.name = "brcmfmac",
	.id_table = brcmf_sdmmc_ids,
#ifdef CONFIG_PM_SLEEP
	.drv = {
		.pm = &brcmf_sdio_pm_ops,
	},
#endif	/* CONFIG_PM_SLEEP */
};

/* bus register interface */
int brcmf_bus_register(void)
{
	brcmf_dbg(TRACE, "Enter\n");

	return sdio_register_driver(&brcmf_sdmmc_driver);
}

void brcmf_bus_unregister(void)
{
	brcmf_dbg(TRACE, "Enter\n");

	sdio_unregister_driver(&brcmf_sdmmc_driver);
}
Commit	Line	Data
5b435de0 AS	1	/*
	2	* Copyright (c) 2010 Broadcom Corporation
	3	*
	4	* Permission to use, copy, modify, and/or distribute this software for any
	5	* purpose with or without fee is hereby granted, provided that the above
	6	* copyright notice and this permission notice appear in all copies.
	7	*
	8	* THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
	9	* WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
	10	* MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
	11	* SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
	12	* WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION
	13	* OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN
	14	* CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
	15	*/
	16	#include <linux/types.h>
	17	#include <linux/netdevice.h>
	18	#include <linux/mmc/sdio.h>
	19	#include <linux/mmc/core.h>
	20	#include <linux/mmc/sdio_func.h>
	21	#include <linux/mmc/sdio_ids.h>
	22	#include <linux/mmc/card.h>
	23	#include <linux/suspend.h>
	24	#include <linux/errno.h>
	25	#include <linux/sched.h> /* request_irq() */
b7a57e76	26	#include <linux/module.h>
5b435de0 AS	27	#include <net/cfg80211.h>
	28
	29	#include <defs.h>
	30	#include <brcm_hw_ids.h>
	31	#include <brcmu_utils.h>
	32	#include <brcmu_wifi.h>
	33	#include "sdio_host.h"
	34	#include "dhd.h"
	35	#include "dhd_dbg.h"
	36	#include "wl_cfg80211.h"
	37
	38	#define SDIO_VENDOR_ID_BROADCOM 0x02d0
	39
	40	#define DMA_ALIGN_MASK 0x03
	41
	42	#define SDIO_DEVICE_ID_BROADCOM_4329 0x4329
	43
	44	#define SDIO_FUNC1_BLOCKSIZE 64
	45	#define SDIO_FUNC2_BLOCKSIZE 512
	46
	47	/* devices we support, null terminated */
	48	static const struct sdio_device_id brcmf_sdmmc_ids[] = {
	49	{SDIO_DEVICE(SDIO_VENDOR_ID_BROADCOM, SDIO_DEVICE_ID_BROADCOM_4329)},
	50	{ /* end: all zeroes */ },
	51	};
	52	MODULE_DEVICE_TABLE(sdio, brcmf_sdmmc_ids);
	53
	54	static bool
	55	brcmf_pm_resume_error(struct brcmf_sdio_dev *sdiodev)
	56	{
	57	bool is_err = false;
	58	#ifdef CONFIG_PM_SLEEP
	59	is_err = atomic_read(&sdiodev->suspend);
	60	#endif
	61	return is_err;
	62	}
	63
	64	static void
	65	brcmf_pm_resume_wait(struct brcmf_sdio_dev sdiodev, wait_queue_head_t wq)
	66	{
	67	#ifdef CONFIG_PM_SLEEP
	68	int retry = 0;
	69	while (atomic_read(&sdiodev->suspend) && retry++ != 30)
	70	wait_event_timeout(*wq, false, HZ/100);
	71	#endif
	72	}
	73
	74	static inline int brcmf_sdioh_f0_write_byte(struct brcmf_sdio_dev *sdiodev,
	75	uint regaddr, u8 *byte)
	76	{
	77	struct sdio_func *sdfunc = sdiodev->func[0];
	78	int err_ret;
	79
	80	/*
	81	* Can only directly write to some F0 registers.
	82	* Handle F2 enable/disable and Abort command
	83	* as a special case.
	84	*/
	85	if (regaddr == SDIO_CCCR_IOEx) {
	86	sdfunc = sdiodev->func[2];
	87	if (sdfunc) {
	88	sdio_claim_host(sdfunc);
	89	if (*byte & SDIO_FUNC_ENABLE_2) {
	90	/* Enable Function 2 */
91	err_ret = sdio_enable_func(sdfunc);
92	if (err_ret)
93	brcmf_dbg(ERROR,
94	"enable F2 failed:%d\n",
95	err_ret);
96	} else {
97	/* Disable Function 2 */
98	err_ret = sdio_disable_func(sdfunc);
99	if (err_ret)
100	brcmf_dbg(ERROR,
101	"Disable F2 failed:%d\n",
102	err_ret);
103	}
104	sdio_release_host(sdfunc);
105	}
106	} else if (regaddr == SDIO_CCCR_ABORT) {
107	sdio_claim_host(sdfunc);
108	sdio_writeb(sdfunc, *byte, regaddr, &err_ret);
109	sdio_release_host(sdfunc);
110	} else if (regaddr < 0xF0) {
111	brcmf_dbg(ERROR, "F0 Wr:0x%02x: write disallowed\n", regaddr);
112	err_ret = -EPERM;
113	} else {
114	sdio_claim_host(sdfunc);
115	sdio_f0_writeb(sdfunc, *byte, regaddr, &err_ret);
116	sdio_release_host(sdfunc);
117	}
118
119	return err_ret;
120	}
121
122	int brcmf_sdioh_request_byte(struct brcmf_sdio_dev *sdiodev, uint rw, uint func,
123	uint regaddr, u8 *byte)
124	{
125	int err_ret;
126
127	brcmf_dbg(INFO, "rw=%d, func=%d, addr=0x%05x\n", rw, func, regaddr);
128
129	brcmf_pm_resume_wait(sdiodev, &sdiodev->request_byte_wait);
130	if (brcmf_pm_resume_error(sdiodev))
131	return -EIO;
132
133	if (rw && func == 0) {
134	/* handle F0 separately */
135	err_ret = brcmf_sdioh_f0_write_byte(sdiodev, regaddr, byte);
136	} else {
137	sdio_claim_host(sdiodev->func[func]);
138	if (rw) /* CMD52 Write */
139	sdio_writeb(sdiodev->func[func], *byte, regaddr,
140	&err_ret);
141	else if (func == 0) {
142	*byte = sdio_f0_readb(sdiodev->func[func], regaddr,
143	&err_ret);
144	} else {
145	*byte = sdio_readb(sdiodev->func[func], regaddr,
146	&err_ret);
147	}
148	sdio_release_host(sdiodev->func[func]);
149	}
150
151	if (err_ret)
152	brcmf_dbg(ERROR, "Failed to %s byte F%d:@0x%05x=%02x, Err: %d\n",
153	rw ? "write" : "read", func, regaddr, *byte, err_ret);
154
155	return err_ret;
156	}
157
158	int brcmf_sdioh_request_word(struct brcmf_sdio_dev *sdiodev,
159	uint rw, uint func, uint addr, u32 *word,
160	uint nbytes)
161	{
162	int err_ret = -EIO;
163
164	if (func == 0) {
165	brcmf_dbg(ERROR, "Only CMD52 allowed to F0\n");
166	return -EINVAL;
167	}
168
169	brcmf_dbg(INFO, "rw=%d, func=%d, addr=0x%05x, nbytes=%d\n",
170	rw, func, addr, nbytes);
171
172	brcmf_pm_resume_wait(sdiodev, &sdiodev->request_word_wait);
173	if (brcmf_pm_resume_error(sdiodev))
174	return -EIO;
175	/* Claim host controller */
176	sdio_claim_host(sdiodev->func[func]);
177
178	if (rw) { /* CMD52 Write */
179	if (nbytes == 4)
180	sdio_writel(sdiodev->func[func], *word, addr,
181	&err_ret);
182	else if (nbytes == 2)
183	sdio_writew(sdiodev->func[func], (*word & 0xFFFF),
184	addr, &err_ret);
185	else
186	brcmf_dbg(ERROR, "Invalid nbytes: %d\n", nbytes);
187	} else { /* CMD52 Read */
188	if (nbytes == 4)
189	*word = sdio_readl(sdiodev->func[func], addr, &err_ret);
190	else if (nbytes == 2)
191	*word = sdio_readw(sdiodev->func[func], addr,
192	&err_ret) & 0xFFFF;
193	else
194	brcmf_dbg(ERROR, "Invalid nbytes: %d\n", nbytes);
195	}
196
197	/* Release host controller */
198	sdio_release_host(sdiodev->func[func]);
199
200	if (err_ret)
201	brcmf_dbg(ERROR, "Failed to %s word, Err: 0x%08x\n",
202	rw ? "write" : "read", err_ret);
203
204	return err_ret;
205	}
206
5adfeb63 AS	207	/* precondition: host controller is claimed */
	208	static int
	209	brcmf_sdioh_request_data(struct brcmf_sdio_dev *sdiodev, uint write, bool fifo,
	210	uint func, uint addr, struct sk_buff *pkt, uint pktlen)
	211	{
	212	int err_ret = 0;
	213
	214	if ((write) && (!fifo)) {
	215	err_ret = sdio_memcpy_toio(sdiodev->func[func], addr,
	216	((u8 *) (pkt->data)), pktlen);
	217	} else if (write) {
	218	err_ret = sdio_memcpy_toio(sdiodev->func[func], addr,
	219	((u8 *) (pkt->data)), pktlen);
	220	} else if (fifo) {
	221	err_ret = sdio_readsb(sdiodev->func[func],
	222	((u8 *) (pkt->data)), addr, pktlen);
	223	} else {
	224	err_ret = sdio_memcpy_fromio(sdiodev->func[func],
	225	((u8 *) (pkt->data)),
	226	addr, pktlen);
	227	}
	228
	229	return err_ret;
	230	}
	231
5b435de0 AS	232	static int
	233	brcmf_sdioh_request_packet(struct brcmf_sdio_dev *sdiodev, uint fix_inc,
	234	uint write, uint func, uint addr,
	235	struct sk_buff *pkt)
5adfeb63 AS	236	{
	237	bool fifo = (fix_inc == SDIOH_DATA_FIX);
	238	int err_ret = 0;
	239	uint pkt_len = pkt->len;
	240
	241	brcmf_dbg(TRACE, "Enter\n");
	242
	243	brcmf_pm_resume_wait(sdiodev, &sdiodev->request_packet_wait);
	244	if (brcmf_pm_resume_error(sdiodev))
	245	return -EIO;
	246
	247	/* Claim host controller */
	248	sdio_claim_host(sdiodev->func[func]);
	249
	250	pkt_len += 3;
	251	pkt_len &= 0xFFFFFFFC;
	252
	253	err_ret = brcmf_sdioh_request_data(sdiodev, write, fifo, func,
	254	addr, pkt, pkt_len);
	255	if (err_ret) {
	256	brcmf_dbg(ERROR, "%s FAILED %p, addr=0x%05x, pkt_len=%d, ERR=0x%08x\n",
	257	write ? "TX" : "RX", pkt, addr, pkt_len, err_ret);
	258	} else {
	259	brcmf_dbg(TRACE, "%s xfr'd %p, addr=0x%05x, len=%d\n",
	260	write ? "TX" : "RX", pkt, addr, pkt_len);
	261	}
	262
	263	/* Release host controller */
	264	sdio_release_host(sdiodev->func[func]);
	265
	266	brcmf_dbg(TRACE, "Exit\n");
	267	return err_ret;
	268	}
	269
	270	int
	271	brcmf_sdioh_request_chain(struct brcmf_sdio_dev *sdiodev, uint fix_inc,
	272	uint write, uint func, uint addr,
	273	struct sk_buff_head *pktq)
5b435de0 AS	274	{
	275	bool fifo = (fix_inc == SDIOH_DATA_FIX);
	276	u32 SGCount = 0;
	277	int err_ret = 0;
	278
5adfeb63	279	struct sk_buff *pkt;
5b435de0 AS	280
	281	brcmf_dbg(TRACE, "Enter\n");
	282
	283	brcmf_pm_resume_wait(sdiodev, &sdiodev->request_packet_wait);
	284	if (brcmf_pm_resume_error(sdiodev))
	285	return -EIO;
	286
	287	/* Claim host controller */
	288	sdio_claim_host(sdiodev->func[func]);
5adfeb63 AS	289
	290	skb_queue_walk(pktq, pkt) {
	291	uint pkt_len = pkt->len;
5b435de0 AS	292	pkt_len += 3;
	293	pkt_len &= 0xFFFFFFFC;
	294
5adfeb63 AS	295	err_ret = brcmf_sdioh_request_data(sdiodev, write, fifo, func,
5adfeb63 AS	296	addr, pkt, pkt_len);
5b435de0 AS	297	if (err_ret) {
5b435de0 AS	298	brcmf_dbg(ERROR, "%s FAILED %p[%d], addr=0x%05x, pkt_len=%d, ERR=0x%08x\n",
5adfeb63	299	write ? "TX" : "RX", pkt, SGCount, addr,
5b435de0 AS	300	pkt_len, err_ret);
	301	} else {
	302	brcmf_dbg(TRACE, "%s xfr'd %p[%d], addr=0x%05x, len=%d\n",
5adfeb63	303	write ? "TX" : "RX", pkt, SGCount, addr,
5b435de0 AS	304	pkt_len);
5b435de0 AS	305	}
5b435de0 AS	306	if (!fifo)
5b435de0 AS	307	addr += pkt_len;
5b435de0	308
5adfeb63	309	SGCount++;
5b435de0 AS	310	}
	311
	312	/* Release host controller */
	313	sdio_release_host(sdiodev->func[func]);
	314
	315	brcmf_dbg(TRACE, "Exit\n");
	316	return err_ret;
	317	}
	318
	319	/*
	320	* This function takes a buffer or packet, and fixes everything up
	321	* so that in the end, a DMA-able packet is created.
	322	*
	323	* A buffer does not have an associated packet pointer,
	324	* and may or may not be aligned.
	325	* A packet may consist of a single packet, or a packet chain.
	326	* If it is a packet chain, then all the packets in the chain
	327	* must be properly aligned.
	328	*
	329	* If the packet data is not aligned, then there may only be
	330	* one packet, and in this case, it is copied to a new
	331	* aligned packet.
	332	*
	333	*/
	334	int brcmf_sdioh_request_buffer(struct brcmf_sdio_dev *sdiodev,
	335	uint fix_inc, uint write, uint func, uint addr,
	336	uint reg_width, uint buflen_u, u8 *buffer,
	337	struct sk_buff *pkt)
	338	{
	339	int Status;
	340	struct sk_buff *mypkt = NULL;
	341
	342	brcmf_dbg(TRACE, "Enter\n");
	343
	344	brcmf_pm_resume_wait(sdiodev, &sdiodev->request_buffer_wait);
	345	if (brcmf_pm_resume_error(sdiodev))
	346	return -EIO;
	347	/* Case 1: we don't have a packet. */
	348	if (pkt == NULL) {
	349	brcmf_dbg(DATA, "Creating new %s Packet, len=%d\n",
	350	write ? "TX" : "RX", buflen_u);
	351	mypkt = brcmu_pkt_buf_get_skb(buflen_u);
	352	if (!mypkt) {
	353	brcmf_dbg(ERROR, "brcmu_pkt_buf_get_skb failed: len %d\n",
	354	buflen_u);
	355	return -EIO;
	356	}
	357
	358	/* For a write, copy the buffer data into the packet. */
	359	if (write)
	360	memcpy(mypkt->data, buffer, buflen_u);
	361
	362	Status = brcmf_sdioh_request_packet(sdiodev, fix_inc, write,
	363	func, addr, mypkt);
	364
	365	/* For a read, copy the packet data back to the buffer. */
	366	if (!write)
	367	memcpy(buffer, mypkt->data, buflen_u);
	368
	369	brcmu_pkt_buf_free_skb(mypkt);
	370	} else if (((ulong) (pkt->data) & DMA_ALIGN_MASK) != 0) {
	371	/*
	372	* Case 2: We have a packet, but it is unaligned.
	373	* In this case, we cannot have a chain (pkt->next == NULL)
374	*/
375	brcmf_dbg(DATA, "Creating aligned %s Packet, len=%d\n",
376	write ? "TX" : "RX", pkt->len);
377	mypkt = brcmu_pkt_buf_get_skb(pkt->len);
378	if (!mypkt) {
379	brcmf_dbg(ERROR, "brcmu_pkt_buf_get_skb failed: len %d\n",
380	pkt->len);
381	return -EIO;
382	}
383
384	/* For a write, copy the buffer data into the packet. */
385	if (write)
386	memcpy(mypkt->data, pkt->data, pkt->len);
387
388	Status = brcmf_sdioh_request_packet(sdiodev, fix_inc, write,
389	func, addr, mypkt);
390
391	/* For a read, copy the packet data back to the buffer. */
392	if (!write)
393	memcpy(pkt->data, mypkt->data, mypkt->len);
394
395	brcmu_pkt_buf_free_skb(mypkt);
396	} else { /* case 3: We have a packet and
397	it is aligned. */
398	brcmf_dbg(DATA, "Aligned %s Packet, direct DMA\n",
399	write ? "Tx" : "Rx");
400	Status = brcmf_sdioh_request_packet(sdiodev, fix_inc, write,
401	func, addr, pkt);
402	}
403
404	return Status;
405	}
406
407	/* Read client card reg */
408	static int
409	brcmf_sdioh_card_regread(struct brcmf_sdio_dev *sdiodev, int func, u32 regaddr,
410	int regsize, u32 *data)
411	{
412
413	if ((func == 0) \|\| (regsize == 1)) {
414	u8 temp = 0;
415
416	brcmf_sdioh_request_byte(sdiodev, SDIOH_READ, func, regaddr,
417	&temp);
418	*data = temp;
419	*data &= 0xff;
420	brcmf_dbg(DATA, "byte read data=0x%02x\n", *data);
421	} else {
422	brcmf_sdioh_request_word(sdiodev, SDIOH_READ, func, regaddr,
423	data, regsize);
424	if (regsize == 2)
425	*data &= 0xffff;
426
427	brcmf_dbg(DATA, "word read data=0x%08x\n", *data);
428	}
429
430	return SUCCESS;
431	}
432
433	static int brcmf_sdioh_get_cisaddr(struct brcmf_sdio_dev *sdiodev, u32 regaddr)
434	{
435	/* read 24 bits and return valid 17 bit addr */
436	int i;
437	u32 scratch, regdata;
438	__le32 scratch_le;
439	u8 ptr = (u8 )&scratch_le;
440
441	for (i = 0; i < 3; i++) {
442	if ((brcmf_sdioh_card_regread(sdiodev, 0, regaddr, 1,
443	&regdata)) != SUCCESS)
444	brcmf_dbg(ERROR, "Can't read!\n");
445
446	*ptr++ = (u8) regdata;
447	regaddr++;
448	}
449
450	/* Only the lower 17-bits are valid */
451	scratch = le32_to_cpu(scratch_le);
452	scratch &= 0x0001FFFF;
453	return scratch;
454	}
455
456	static int brcmf_sdioh_enablefuncs(struct brcmf_sdio_dev *sdiodev)
457	{
458	int err_ret;
459	u32 fbraddr;
460	u8 func;
461
462	brcmf_dbg(TRACE, "\n");
463
464	/* Get the Card's common CIS address */
465	sdiodev->func_cis_ptr[0] = brcmf_sdioh_get_cisaddr(sdiodev,
466	SDIO_CCCR_CIS);
467	brcmf_dbg(INFO, "Card's Common CIS Ptr = 0x%x\n",
468	sdiodev->func_cis_ptr[0]);
469
470	/* Get the Card's function CIS (for each function) */
471	for (fbraddr = SDIO_FBR_BASE(1), func = 1;
472	func <= sdiodev->num_funcs; func++, fbraddr += SDIOD_FBR_SIZE) {
473	sdiodev->func_cis_ptr[func] =
474	brcmf_sdioh_get_cisaddr(sdiodev, SDIO_FBR_CIS + fbraddr);
475	brcmf_dbg(INFO, "Function %d CIS Ptr = 0x%x\n",
476	func, sdiodev->func_cis_ptr[func]);
477	}
478
479	/* Enable Function 1 */
480	sdio_claim_host(sdiodev->func[1]);
481	err_ret = sdio_enable_func(sdiodev->func[1]);
482	sdio_release_host(sdiodev->func[1]);
483	if (err_ret)
484	brcmf_dbg(ERROR, "Failed to enable F1 Err: 0x%08x\n", err_ret);
485
486	return false;
487	}
488
489	/*
490	* Public entry points & extern's
491	*/
492	int brcmf_sdioh_attach(struct brcmf_sdio_dev *sdiodev)
493	{
494	int err_ret = 0;
495
496	brcmf_dbg(TRACE, "\n");
497
498	sdiodev->num_funcs = 2;
499
500	sdio_claim_host(sdiodev->func[1]);
501	err_ret = sdio_set_block_size(sdiodev->func[1], SDIO_FUNC1_BLOCKSIZE);
502	sdio_release_host(sdiodev->func[1]);
503	if (err_ret) {
504	brcmf_dbg(ERROR, "Failed to set F1 blocksize\n");
505	goto out;
506	}
507
508	sdio_claim_host(sdiodev->func[2]);
509	err_ret = sdio_set_block_size(sdiodev->func[2], SDIO_FUNC2_BLOCKSIZE);
510	sdio_release_host(sdiodev->func[2]);
511	if (err_ret) {
512	brcmf_dbg(ERROR, "Failed to set F2 blocksize\n");
513	goto out;
514	}
515
516	brcmf_sdioh_enablefuncs(sdiodev);
517
518	out:
519	brcmf_dbg(TRACE, "Done\n");
520	return err_ret;
521	}
522
523	void brcmf_sdioh_detach(struct brcmf_sdio_dev *sdiodev)
524	{
525	brcmf_dbg(TRACE, "\n");
526
527	/* Disable Function 2 */
528	sdio_claim_host(sdiodev->func[2]);
529	sdio_disable_func(sdiodev->func[2]);
530	sdio_release_host(sdiodev->func[2]);
531
532	/* Disable Function 1 */
533	sdio_claim_host(sdiodev->func[1]);
534	sdio_disable_func(sdiodev->func[1]);
535	sdio_release_host(sdiodev->func[1]);
536
537	}
538
539	static int brcmf_ops_sdio_probe(struct sdio_func *func,
540	const struct sdio_device_id *id)
541	{
542	int ret = 0;
543	struct brcmf_sdio_dev *sdiodev;
544	brcmf_dbg(TRACE, "Enter\n");
545	brcmf_dbg(TRACE, "func->class=%x\n", func->class);
546	brcmf_dbg(TRACE, "sdio_vendor: 0x%04x\n", func->vendor);
547	brcmf_dbg(TRACE, "sdio_device: 0x%04x\n", func->device);
548	brcmf_dbg(TRACE, "Function#: 0x%04x\n", func->num);
549
550	if (func->num == 1) {
551	if (dev_get_drvdata(&func->card->dev)) {
552	brcmf_dbg(ERROR, "card private drvdata occupied\n");
553	return -ENXIO;
554	}
555	sdiodev = kzalloc(sizeof(struct brcmf_sdio_dev), GFP_KERNEL);
556	if (!sdiodev)
557	return -ENOMEM;
558	sdiodev->func[0] = func->card->sdio_func[0];
559	sdiodev->func[1] = func;
560	dev_set_drvdata(&func->card->dev, sdiodev);
561
562	atomic_set(&sdiodev->suspend, false);
563	init_waitqueue_head(&sdiodev->request_byte_wait);
564	init_waitqueue_head(&sdiodev->request_word_wait);
565	init_waitqueue_head(&sdiodev->request_packet_wait);
566	init_waitqueue_head(&sdiodev->request_buffer_wait);
567	}
568
569	if (func->num == 2) {
570	sdiodev = dev_get_drvdata(&func->card->dev);
571	if ((!sdiodev) \|\| (sdiodev->func[1]->card != func->card))
572	return -ENODEV;
573	sdiodev->func[2] = func;
574
575	brcmf_dbg(TRACE, "F2 found, calling brcmf_sdio_probe...\n");
576	ret = brcmf_sdio_probe(sdiodev);
577	}
578
579	return ret;
580	}
581
582	static void brcmf_ops_sdio_remove(struct sdio_func *func)
583	{
584	struct brcmf_sdio_dev *sdiodev;
585	brcmf_dbg(TRACE, "Enter\n");
586	brcmf_dbg(INFO, "func->class=%x\n", func->class);
587	brcmf_dbg(INFO, "sdio_vendor: 0x%04x\n", func->vendor);
588	brcmf_dbg(INFO, "sdio_device: 0x%04x\n", func->device);
589	brcmf_dbg(INFO, "Function#: 0x%04x\n", func->num);
590
591	if (func->num == 2) {
592	sdiodev = dev_get_drvdata(&func->card->dev);
593	brcmf_dbg(TRACE, "F2 found, calling brcmf_sdio_remove...\n");
594	brcmf_sdio_remove(sdiodev);
595	dev_set_drvdata(&func->card->dev, NULL);
596	kfree(sdiodev);
597	}
598	}
599
600	#ifdef CONFIG_PM_SLEEP
601	static int brcmf_sdio_suspend(struct device *dev)
602	{
603	mmc_pm_flag_t sdio_flags;
604	struct brcmf_sdio_dev *sdiodev;
605	struct sdio_func *func = dev_to_sdio_func(dev);
606	int ret = 0;
607
608	brcmf_dbg(TRACE, "\n");
609
610	sdiodev = dev_get_drvdata(&func->card->dev);
611
612	atomic_set(&sdiodev->suspend, true);
613
614	sdio_flags = sdio_get_host_pm_caps(sdiodev->func[1]);
615	if (!(sdio_flags & MMC_PM_KEEP_POWER)) {
616	brcmf_dbg(ERROR, "Host can't keep power while suspended\n");
617	return -EINVAL;
618	}
619
620	ret = sdio_set_host_pm_flags(sdiodev->func[1], MMC_PM_KEEP_POWER);
621	if (ret) {
622	brcmf_dbg(ERROR, "Failed to set pm_flags\n");
623	return ret;
624	}
625
626	brcmf_sdio_wdtmr_enable(sdiodev, false);
627
628	return ret;
629	}
630
631	static int brcmf_sdio_resume(struct device *dev)
632	{
633	struct brcmf_sdio_dev *sdiodev;
634	struct sdio_func *func = dev_to_sdio_func(dev);
635
636	sdiodev = dev_get_drvdata(&func->card->dev);
637	brcmf_sdio_wdtmr_enable(sdiodev, true);
638	atomic_set(&sdiodev->suspend, false);
639	return 0;
640	}
641
642	static const struct dev_pm_ops brcmf_sdio_pm_ops = {
643	.suspend = brcmf_sdio_suspend,
644	.resume = brcmf_sdio_resume,
645	};
646	#endif /* CONFIG_PM_SLEEP */
647
648	static struct sdio_driver brcmf_sdmmc_driver = {
649	.probe = brcmf_ops_sdio_probe,
650	.remove = brcmf_ops_sdio_remove,
651	.name = "brcmfmac",
652	.id_table = brcmf_sdmmc_ids,
653	#ifdef CONFIG_PM_SLEEP
654	.drv = {
655	.pm = &brcmf_sdio_pm_ops,
656	},
657	#endif /* CONFIG_PM_SLEEP */
658	};
659
660	/* bus register interface */
661	int brcmf_bus_register(void)
662	{
663	brcmf_dbg(TRACE, "Enter\n");
664
665	return sdio_register_driver(&brcmf_sdmmc_driver);
666	}
667
668	void brcmf_bus_unregister(void)
669	{
670	brcmf_dbg(TRACE, "Enter\n");
671
672	sdio_unregister_driver(&brcmf_sdmmc_driver);
673	}