[linux-2.6-block.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,
			       struct sk_buff *pkt)
{
	int status;
	struct sk_buff *mypkt = NULL;

	brcmf_dbg(TRACE, "Enter\n");

	if (pkt == NULL)
		return -EINVAL;

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

	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,
4c6e869d	336	struct sk_buff *pkt)
5b435de0	337	{
4c6e869d	338	int status;
5b435de0 AS	339	struct sk_buff *mypkt = NULL;
	340
	341	brcmf_dbg(TRACE, "Enter\n");
	342
4c6e869d AS	343	if (pkt == NULL)
	344	return -EINVAL;
	345
5b435de0 AS	346	brcmf_pm_resume_wait(sdiodev, &sdiodev->request_buffer_wait);
	347	if (brcmf_pm_resume_error(sdiodev))
	348	return -EIO;
5b435de0	349
4c6e869d	350	if (((ulong) (pkt->data) & DMA_ALIGN_MASK) != 0) {
5b435de0 AS	351	/*
	352	* Case 2: We have a packet, but it is unaligned.
	353	* In this case, we cannot have a chain (pkt->next == NULL)
	354	*/
	355	brcmf_dbg(DATA, "Creating aligned %s Packet, len=%d\n",
	356	write ? "TX" : "RX", pkt->len);
	357	mypkt = brcmu_pkt_buf_get_skb(pkt->len);
	358	if (!mypkt) {
	359	brcmf_dbg(ERROR, "brcmu_pkt_buf_get_skb failed: len %d\n",
	360	pkt->len);
	361	return -EIO;
	362	}
	363
	364	/* For a write, copy the buffer data into the packet. */
	365	if (write)
	366	memcpy(mypkt->data, pkt->data, pkt->len);
	367
4c6e869d	368	status = brcmf_sdioh_request_packet(sdiodev, fix_inc, write,
5b435de0 AS	369	func, addr, mypkt);
	370
	371	/* For a read, copy the packet data back to the buffer. */
	372	if (!write)
	373	memcpy(pkt->data, mypkt->data, mypkt->len);
	374
	375	brcmu_pkt_buf_free_skb(mypkt);
	376	} else { /* case 3: We have a packet and
	377	it is aligned. */
	378	brcmf_dbg(DATA, "Aligned %s Packet, direct DMA\n",
	379	write ? "Tx" : "Rx");
4c6e869d	380	status = brcmf_sdioh_request_packet(sdiodev, fix_inc, write,
5b435de0 AS	381	func, addr, pkt);
	382	}
	383
4c6e869d	384	return status;
5b435de0 AS	385	}
	386
	387	/* Read client card reg */
	388	static int
	389	brcmf_sdioh_card_regread(struct brcmf_sdio_dev *sdiodev, int func, u32 regaddr,
	390	int regsize, u32 *data)
	391	{
	392
	393	if ((func == 0) \|\| (regsize == 1)) {
	394	u8 temp = 0;
	395
	396	brcmf_sdioh_request_byte(sdiodev, SDIOH_READ, func, regaddr,
	397	&temp);
	398	*data = temp;
	399	*data &= 0xff;
	400	brcmf_dbg(DATA, "byte read data=0x%02x\n", *data);
	401	} else {
	402	brcmf_sdioh_request_word(sdiodev, SDIOH_READ, func, regaddr,
	403	data, regsize);
	404	if (regsize == 2)
	405	*data &= 0xffff;
	406
	407	brcmf_dbg(DATA, "word read data=0x%08x\n", *data);
	408	}
	409
	410	return SUCCESS;
	411	}
	412
	413	static int brcmf_sdioh_get_cisaddr(struct brcmf_sdio_dev *sdiodev, u32 regaddr)
	414	{
	415	/* read 24 bits and return valid 17 bit addr */
	416	int i;
	417	u32 scratch, regdata;
	418	__le32 scratch_le;
	419	u8 ptr = (u8 )&scratch_le;
	420
	421	for (i = 0; i < 3; i++) {
	422	if ((brcmf_sdioh_card_regread(sdiodev, 0, regaddr, 1,
	423	&regdata)) != SUCCESS)
	424	brcmf_dbg(ERROR, "Can't read!\n");
	425
	426	*ptr++ = (u8) regdata;
	427	regaddr++;
	428	}
	429
	430	/* Only the lower 17-bits are valid */
	431	scratch = le32_to_cpu(scratch_le);
	432	scratch &= 0x0001FFFF;
	433	return scratch;
	434	}
	435
	436	static int brcmf_sdioh_enablefuncs(struct brcmf_sdio_dev *sdiodev)
	437	{
	438	int err_ret;
	439	u32 fbraddr;
	440	u8 func;
	441
	442	brcmf_dbg(TRACE, "\n");
	443
	444	/* Get the Card's common CIS address */
	445	sdiodev->func_cis_ptr[0] = brcmf_sdioh_get_cisaddr(sdiodev,
	446	SDIO_CCCR_CIS);
	447	brcmf_dbg(INFO, "Card's Common CIS Ptr = 0x%x\n",
	448	sdiodev->func_cis_ptr[0]);
449
450	/* Get the Card's function CIS (for each function) */
451	for (fbraddr = SDIO_FBR_BASE(1), func = 1;
452	func <= sdiodev->num_funcs; func++, fbraddr += SDIOD_FBR_SIZE) {
453	sdiodev->func_cis_ptr[func] =
454	brcmf_sdioh_get_cisaddr(sdiodev, SDIO_FBR_CIS + fbraddr);
455	brcmf_dbg(INFO, "Function %d CIS Ptr = 0x%x\n",
456	func, sdiodev->func_cis_ptr[func]);
457	}
458
459	/* Enable Function 1 */
460	sdio_claim_host(sdiodev->func[1]);
461	err_ret = sdio_enable_func(sdiodev->func[1]);
462	sdio_release_host(sdiodev->func[1]);
463	if (err_ret)
464	brcmf_dbg(ERROR, "Failed to enable F1 Err: 0x%08x\n", err_ret);
465
466	return false;
467	}
468
469	/*
470	* Public entry points & extern's
471	*/
472	int brcmf_sdioh_attach(struct brcmf_sdio_dev *sdiodev)
473	{
474	int err_ret = 0;
475
476	brcmf_dbg(TRACE, "\n");
477
478	sdiodev->num_funcs = 2;
479
480	sdio_claim_host(sdiodev->func[1]);
481	err_ret = sdio_set_block_size(sdiodev->func[1], SDIO_FUNC1_BLOCKSIZE);
482	sdio_release_host(sdiodev->func[1]);
483	if (err_ret) {
484	brcmf_dbg(ERROR, "Failed to set F1 blocksize\n");
485	goto out;
486	}
487
488	sdio_claim_host(sdiodev->func[2]);
489	err_ret = sdio_set_block_size(sdiodev->func[2], SDIO_FUNC2_BLOCKSIZE);
490	sdio_release_host(sdiodev->func[2]);
491	if (err_ret) {
492	brcmf_dbg(ERROR, "Failed to set F2 blocksize\n");
493	goto out;
494	}
495
496	brcmf_sdioh_enablefuncs(sdiodev);
497
498	out:
499	brcmf_dbg(TRACE, "Done\n");
500	return err_ret;
501	}
502
503	void brcmf_sdioh_detach(struct brcmf_sdio_dev *sdiodev)
504	{
505	brcmf_dbg(TRACE, "\n");
506
507	/* Disable Function 2 */
508	sdio_claim_host(sdiodev->func[2]);
509	sdio_disable_func(sdiodev->func[2]);
510	sdio_release_host(sdiodev->func[2]);
511
512	/* Disable Function 1 */
513	sdio_claim_host(sdiodev->func[1]);
514	sdio_disable_func(sdiodev->func[1]);
515	sdio_release_host(sdiodev->func[1]);
516
517	}
518
519	static int brcmf_ops_sdio_probe(struct sdio_func *func,
520	const struct sdio_device_id *id)
521	{
522	int ret = 0;
523	struct brcmf_sdio_dev *sdiodev;
524	brcmf_dbg(TRACE, "Enter\n");
525	brcmf_dbg(TRACE, "func->class=%x\n", func->class);
526	brcmf_dbg(TRACE, "sdio_vendor: 0x%04x\n", func->vendor);
527	brcmf_dbg(TRACE, "sdio_device: 0x%04x\n", func->device);
528	brcmf_dbg(TRACE, "Function#: 0x%04x\n", func->num);
529
530	if (func->num == 1) {
531	if (dev_get_drvdata(&func->card->dev)) {
532	brcmf_dbg(ERROR, "card private drvdata occupied\n");
533	return -ENXIO;
534	}
535	sdiodev = kzalloc(sizeof(struct brcmf_sdio_dev), GFP_KERNEL);
536	if (!sdiodev)
537	return -ENOMEM;
538	sdiodev->func[0] = func->card->sdio_func[0];
539	sdiodev->func[1] = func;
540	dev_set_drvdata(&func->card->dev, sdiodev);
541
542	atomic_set(&sdiodev->suspend, false);
543	init_waitqueue_head(&sdiodev->request_byte_wait);
544	init_waitqueue_head(&sdiodev->request_word_wait);
545	init_waitqueue_head(&sdiodev->request_packet_wait);
546	init_waitqueue_head(&sdiodev->request_buffer_wait);
547	}
548
549	if (func->num == 2) {
550	sdiodev = dev_get_drvdata(&func->card->dev);
551	if ((!sdiodev) \|\| (sdiodev->func[1]->card != func->card))
552	return -ENODEV;
553	sdiodev->func[2] = func;
554
555	brcmf_dbg(TRACE, "F2 found, calling brcmf_sdio_probe...\n");
556	ret = brcmf_sdio_probe(sdiodev);
557	}
558
559	return ret;
560	}
561
562	static void brcmf_ops_sdio_remove(struct sdio_func *func)
563	{
564	struct brcmf_sdio_dev *sdiodev;
565	brcmf_dbg(TRACE, "Enter\n");
566	brcmf_dbg(INFO, "func->class=%x\n", func->class);
567	brcmf_dbg(INFO, "sdio_vendor: 0x%04x\n", func->vendor);
568	brcmf_dbg(INFO, "sdio_device: 0x%04x\n", func->device);
569	brcmf_dbg(INFO, "Function#: 0x%04x\n", func->num);
570
571	if (func->num == 2) {
572	sdiodev = dev_get_drvdata(&func->card->dev);
573	brcmf_dbg(TRACE, "F2 found, calling brcmf_sdio_remove...\n");
574	brcmf_sdio_remove(sdiodev);
575	dev_set_drvdata(&func->card->dev, NULL);
576	kfree(sdiodev);
577	}
578	}
579
580	#ifdef CONFIG_PM_SLEEP
581	static int brcmf_sdio_suspend(struct device *dev)
582	{
583	mmc_pm_flag_t sdio_flags;
584	struct brcmf_sdio_dev *sdiodev;
585	struct sdio_func *func = dev_to_sdio_func(dev);
586	int ret = 0;
587
588	brcmf_dbg(TRACE, "\n");
589
590	sdiodev = dev_get_drvdata(&func->card->dev);
591
592	atomic_set(&sdiodev->suspend, true);
593
594	sdio_flags = sdio_get_host_pm_caps(sdiodev->func[1]);
595	if (!(sdio_flags & MMC_PM_KEEP_POWER)) {
596	brcmf_dbg(ERROR, "Host can't keep power while suspended\n");
597	return -EINVAL;
598	}
599
600	ret = sdio_set_host_pm_flags(sdiodev->func[1], MMC_PM_KEEP_POWER);
601	if (ret) {
602	brcmf_dbg(ERROR, "Failed to set pm_flags\n");
603	return ret;
604	}
605
606	brcmf_sdio_wdtmr_enable(sdiodev, false);
607
608	return ret;
609	}
610
611	static int brcmf_sdio_resume(struct device *dev)
612	{
613	struct brcmf_sdio_dev *sdiodev;
614	struct sdio_func *func = dev_to_sdio_func(dev);
615
616	sdiodev = dev_get_drvdata(&func->card->dev);
617	brcmf_sdio_wdtmr_enable(sdiodev, true);
618	atomic_set(&sdiodev->suspend, false);
619	return 0;
620	}
621
622	static const struct dev_pm_ops brcmf_sdio_pm_ops = {
623	.suspend = brcmf_sdio_suspend,
624	.resume = brcmf_sdio_resume,
625	};
626	#endif /* CONFIG_PM_SLEEP */
627
628	static struct sdio_driver brcmf_sdmmc_driver = {
629	.probe = brcmf_ops_sdio_probe,
630	.remove = brcmf_ops_sdio_remove,
631	.name = "brcmfmac",
632	.id_table = brcmf_sdmmc_ids,
633	#ifdef CONFIG_PM_SLEEP
634	.drv = {
635	.pm = &brcmf_sdio_pm_ops,
636	},
637	#endif /* CONFIG_PM_SLEEP */
638	};
639
640	/* bus register interface */
641	int brcmf_bus_register(void)
642	{
643	brcmf_dbg(TRACE, "Enter\n");
644
645	return sdio_register_driver(&brcmf_sdmmc_driver);
646	}
647
648	void brcmf_bus_unregister(void)
649	{
650	brcmf_dbg(TRACE, "Enter\n");
651
652	sdio_unregister_driver(&brcmf_sdmmc_driver);
653	}