[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;
}

/*
 * This function takes a queue of packets. The packets on the queue
 * are assumed to be properly aligned by the caller.
 */
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_chain_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 single DMA-able 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;
	uint pkt_len = pkt->len;
	bool fifo = (fix_inc == SDIOH_DATA_FIX);

	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;

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

	pkt_len += 3;
	pkt_len &= (uint)~3;

	status = brcmf_sdioh_request_data(sdiodev, write, fifo, func,
					   addr, pkt, pkt_len);
	if (status) {
		brcmf_dbg(ERROR, "%s FAILED %p, addr=0x%05x, pkt_len=%d, ERR=0x%08x\n",
			  write ? "TX" : "RX", pkt, addr, pkt_len, status);
	} 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]);

	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_chain_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
a52dd17d AS	232	/*
	233	* This function takes a queue of packets. The packets on the queue
	234	* are assumed to be properly aligned by the caller.
	235	*/
5adfeb63 AS	236	int
	237	brcmf_sdioh_request_chain(struct brcmf_sdio_dev *sdiodev, uint fix_inc,
	238	uint write, uint func, uint addr,
	239	struct sk_buff_head *pktq)
5b435de0 AS	240	{
	241	bool fifo = (fix_inc == SDIOH_DATA_FIX);
	242	u32 SGCount = 0;
	243	int err_ret = 0;
	244
5adfeb63	245	struct sk_buff *pkt;
5b435de0 AS	246
	247	brcmf_dbg(TRACE, "Enter\n");
	248
a52dd17d	249	brcmf_pm_resume_wait(sdiodev, &sdiodev->request_chain_wait);
5b435de0 AS	250	if (brcmf_pm_resume_error(sdiodev))
	251	return -EIO;
	252
	253	/* Claim host controller */
	254	sdio_claim_host(sdiodev->func[func]);
5adfeb63 AS	255
	256	skb_queue_walk(pktq, pkt) {
	257	uint pkt_len = pkt->len;
5b435de0 AS	258	pkt_len += 3;
	259	pkt_len &= 0xFFFFFFFC;
	260
5adfeb63 AS	261	err_ret = brcmf_sdioh_request_data(sdiodev, write, fifo, func,
5adfeb63 AS	262	addr, pkt, pkt_len);
5b435de0 AS	263	if (err_ret) {
5b435de0 AS	264	brcmf_dbg(ERROR, "%s FAILED %p[%d], addr=0x%05x, pkt_len=%d, ERR=0x%08x\n",
5adfeb63	265	write ? "TX" : "RX", pkt, SGCount, addr,
5b435de0 AS	266	pkt_len, err_ret);
	267	} else {
	268	brcmf_dbg(TRACE, "%s xfr'd %p[%d], addr=0x%05x, len=%d\n",
5adfeb63	269	write ? "TX" : "RX", pkt, SGCount, addr,
5b435de0 AS	270	pkt_len);
5b435de0 AS	271	}
5b435de0 AS	272	if (!fifo)
5b435de0 AS	273	addr += pkt_len;
5b435de0	274
5adfeb63	275	SGCount++;
5b435de0 AS	276	}
	277
	278	/* Release host controller */
	279	sdio_release_host(sdiodev->func[func]);
	280
	281	brcmf_dbg(TRACE, "Exit\n");
	282	return err_ret;
	283	}
	284
	285	/*
8054321b	286	* This function takes a single DMA-able packet.
5b435de0 AS	287	*/
	288	int brcmf_sdioh_request_buffer(struct brcmf_sdio_dev *sdiodev,
	289	uint fix_inc, uint write, uint func, uint addr,
4c6e869d	290	struct sk_buff *pkt)
5b435de0	291	{
4c6e869d	292	int status;
8054321b AS	293	uint pkt_len = pkt->len;
8054321b AS	294	bool fifo = (fix_inc == SDIOH_DATA_FIX);
5b435de0 AS	295
	296	brcmf_dbg(TRACE, "Enter\n");
	297
4c6e869d AS	298	if (pkt == NULL)
	299	return -EINVAL;
	300
5b435de0 AS	301	brcmf_pm_resume_wait(sdiodev, &sdiodev->request_buffer_wait);
	302	if (brcmf_pm_resume_error(sdiodev))
	303	return -EIO;
5b435de0	304
8054321b AS	305	/* Claim host controller */
8054321b AS	306	sdio_claim_host(sdiodev->func[func]);
5b435de0	307
8054321b AS	308	pkt_len += 3;
8054321b AS	309	pkt_len &= (uint)~3;
5b435de0	310
8054321b AS	311	status = brcmf_sdioh_request_data(sdiodev, write, fifo, func,
	312	addr, pkt, pkt_len);
	313	if (status) {
	314	brcmf_dbg(ERROR, "%s FAILED %p, addr=0x%05x, pkt_len=%d, ERR=0x%08x\n",
	315	write ? "TX" : "RX", pkt, addr, pkt_len, status);
	316	} else {
	317	brcmf_dbg(TRACE, "%s xfr'd %p, addr=0x%05x, len=%d\n",
	318	write ? "TX" : "RX", pkt, addr, pkt_len);
5b435de0 AS	319	}
5b435de0 AS	320
8054321b AS	321	/* Release host controller */
	322	sdio_release_host(sdiodev->func[func]);
	323
4c6e869d	324	return status;
5b435de0 AS	325	}
	326
	327	/* Read client card reg */
	328	static int
	329	brcmf_sdioh_card_regread(struct brcmf_sdio_dev *sdiodev, int func, u32 regaddr,
	330	int regsize, u32 *data)
	331	{
	332
	333	if ((func == 0) \|\| (regsize == 1)) {
	334	u8 temp = 0;
	335
	336	brcmf_sdioh_request_byte(sdiodev, SDIOH_READ, func, regaddr,
	337	&temp);
	338	*data = temp;
	339	*data &= 0xff;
	340	brcmf_dbg(DATA, "byte read data=0x%02x\n", *data);
	341	} else {
	342	brcmf_sdioh_request_word(sdiodev, SDIOH_READ, func, regaddr,
	343	data, regsize);
	344	if (regsize == 2)
	345	*data &= 0xffff;
	346
	347	brcmf_dbg(DATA, "word read data=0x%08x\n", *data);
	348	}
	349
	350	return SUCCESS;
	351	}
	352
	353	static int brcmf_sdioh_get_cisaddr(struct brcmf_sdio_dev *sdiodev, u32 regaddr)
	354	{
	355	/* read 24 bits and return valid 17 bit addr */
	356	int i;
	357	u32 scratch, regdata;
	358	__le32 scratch_le;
	359	u8 ptr = (u8 )&scratch_le;
	360
	361	for (i = 0; i < 3; i++) {
	362	if ((brcmf_sdioh_card_regread(sdiodev, 0, regaddr, 1,
	363	&regdata)) != SUCCESS)
	364	brcmf_dbg(ERROR, "Can't read!\n");
	365
	366	*ptr++ = (u8) regdata;
	367	regaddr++;
	368	}
	369
	370	/* Only the lower 17-bits are valid */
	371	scratch = le32_to_cpu(scratch_le);
	372	scratch &= 0x0001FFFF;
	373	return scratch;
	374	}
	375
	376	static int brcmf_sdioh_enablefuncs(struct brcmf_sdio_dev *sdiodev)
	377	{
	378	int err_ret;
	379	u32 fbraddr;
	380	u8 func;
	381
	382	brcmf_dbg(TRACE, "\n");
	383
	384	/* Get the Card's common CIS address */
	385	sdiodev->func_cis_ptr[0] = brcmf_sdioh_get_cisaddr(sdiodev,
	386	SDIO_CCCR_CIS);
	387	brcmf_dbg(INFO, "Card's Common CIS Ptr = 0x%x\n",
	388	sdiodev->func_cis_ptr[0]);
389
390	/* Get the Card's function CIS (for each function) */
391	for (fbraddr = SDIO_FBR_BASE(1), func = 1;
392	func <= sdiodev->num_funcs; func++, fbraddr += SDIOD_FBR_SIZE) {
393	sdiodev->func_cis_ptr[func] =
394	brcmf_sdioh_get_cisaddr(sdiodev, SDIO_FBR_CIS + fbraddr);
395	brcmf_dbg(INFO, "Function %d CIS Ptr = 0x%x\n",
396	func, sdiodev->func_cis_ptr[func]);
397	}
398
399	/* Enable Function 1 */
400	sdio_claim_host(sdiodev->func[1]);
401	err_ret = sdio_enable_func(sdiodev->func[1]);
402	sdio_release_host(sdiodev->func[1]);
403	if (err_ret)
404	brcmf_dbg(ERROR, "Failed to enable F1 Err: 0x%08x\n", err_ret);
405
406	return false;
407	}
408
409	/*
410	* Public entry points & extern's
411	*/
412	int brcmf_sdioh_attach(struct brcmf_sdio_dev *sdiodev)
413	{
414	int err_ret = 0;
415
416	brcmf_dbg(TRACE, "\n");
417
418	sdiodev->num_funcs = 2;
419
420	sdio_claim_host(sdiodev->func[1]);
421	err_ret = sdio_set_block_size(sdiodev->func[1], SDIO_FUNC1_BLOCKSIZE);
422	sdio_release_host(sdiodev->func[1]);
423	if (err_ret) {
424	brcmf_dbg(ERROR, "Failed to set F1 blocksize\n");
425	goto out;
426	}
427
428	sdio_claim_host(sdiodev->func[2]);
429	err_ret = sdio_set_block_size(sdiodev->func[2], SDIO_FUNC2_BLOCKSIZE);
430	sdio_release_host(sdiodev->func[2]);
431	if (err_ret) {
432	brcmf_dbg(ERROR, "Failed to set F2 blocksize\n");
433	goto out;
434	}
435
436	brcmf_sdioh_enablefuncs(sdiodev);
437
438	out:
439	brcmf_dbg(TRACE, "Done\n");
440	return err_ret;
441	}
442
443	void brcmf_sdioh_detach(struct brcmf_sdio_dev *sdiodev)
444	{
445	brcmf_dbg(TRACE, "\n");
446
447	/* Disable Function 2 */
448	sdio_claim_host(sdiodev->func[2]);
449	sdio_disable_func(sdiodev->func[2]);
450	sdio_release_host(sdiodev->func[2]);
451
452	/* Disable Function 1 */
453	sdio_claim_host(sdiodev->func[1]);
454	sdio_disable_func(sdiodev->func[1]);
455	sdio_release_host(sdiodev->func[1]);
456
457	}
458
459	static int brcmf_ops_sdio_probe(struct sdio_func *func,
460	const struct sdio_device_id *id)
461	{
462	int ret = 0;
463	struct brcmf_sdio_dev *sdiodev;
464	brcmf_dbg(TRACE, "Enter\n");
465	brcmf_dbg(TRACE, "func->class=%x\n", func->class);
466	brcmf_dbg(TRACE, "sdio_vendor: 0x%04x\n", func->vendor);
467	brcmf_dbg(TRACE, "sdio_device: 0x%04x\n", func->device);
468	brcmf_dbg(TRACE, "Function#: 0x%04x\n", func->num);
469
470	if (func->num == 1) {
471	if (dev_get_drvdata(&func->card->dev)) {
472	brcmf_dbg(ERROR, "card private drvdata occupied\n");
473	return -ENXIO;
474	}
475	sdiodev = kzalloc(sizeof(struct brcmf_sdio_dev), GFP_KERNEL);
476	if (!sdiodev)
477	return -ENOMEM;
478	sdiodev->func[0] = func->card->sdio_func[0];
479	sdiodev->func[1] = func;
480	dev_set_drvdata(&func->card->dev, sdiodev);
481
482	atomic_set(&sdiodev->suspend, false);
483	init_waitqueue_head(&sdiodev->request_byte_wait);
484	init_waitqueue_head(&sdiodev->request_word_wait);
a52dd17d	485	init_waitqueue_head(&sdiodev->request_chain_wait);
5b435de0 AS	486	init_waitqueue_head(&sdiodev->request_buffer_wait);
	487	}
	488
	489	if (func->num == 2) {
	490	sdiodev = dev_get_drvdata(&func->card->dev);
	491	if ((!sdiodev) \|\| (sdiodev->func[1]->card != func->card))
	492	return -ENODEV;
	493	sdiodev->func[2] = func;
	494
	495	brcmf_dbg(TRACE, "F2 found, calling brcmf_sdio_probe...\n");
	496	ret = brcmf_sdio_probe(sdiodev);
	497	}
	498
	499	return ret;
	500	}
	501
	502	static void brcmf_ops_sdio_remove(struct sdio_func *func)
	503	{
	504	struct brcmf_sdio_dev *sdiodev;
	505	brcmf_dbg(TRACE, "Enter\n");
	506	brcmf_dbg(INFO, "func->class=%x\n", func->class);
	507	brcmf_dbg(INFO, "sdio_vendor: 0x%04x\n", func->vendor);
	508	brcmf_dbg(INFO, "sdio_device: 0x%04x\n", func->device);
	509	brcmf_dbg(INFO, "Function#: 0x%04x\n", func->num);
	510
	511	if (func->num == 2) {
	512	sdiodev = dev_get_drvdata(&func->card->dev);
	513	brcmf_dbg(TRACE, "F2 found, calling brcmf_sdio_remove...\n");
	514	brcmf_sdio_remove(sdiodev);
	515	dev_set_drvdata(&func->card->dev, NULL);
	516	kfree(sdiodev);
	517	}
	518	}
	519
	520	#ifdef CONFIG_PM_SLEEP
	521	static int brcmf_sdio_suspend(struct device *dev)
	522	{
	523	mmc_pm_flag_t sdio_flags;
	524	struct brcmf_sdio_dev *sdiodev;
	525	struct sdio_func *func = dev_to_sdio_func(dev);
	526	int ret = 0;
	527
	528	brcmf_dbg(TRACE, "\n");
	529
	530	sdiodev = dev_get_drvdata(&func->card->dev);
	531
	532	atomic_set(&sdiodev->suspend, true);
	533
	534	sdio_flags = sdio_get_host_pm_caps(sdiodev->func[1]);
	535	if (!(sdio_flags & MMC_PM_KEEP_POWER)) {
	536	brcmf_dbg(ERROR, "Host can't keep power while suspended\n");
	537	return -EINVAL;
	538	}
	539
	540	ret = sdio_set_host_pm_flags(sdiodev->func[1], MMC_PM_KEEP_POWER);
	541	if (ret) {
	542	brcmf_dbg(ERROR, "Failed to set pm_flags\n");
	543	return ret;
	544	}
	545
	546	brcmf_sdio_wdtmr_enable(sdiodev, false);
	547
	548	return ret;
	549	}
550
551	static int brcmf_sdio_resume(struct device *dev)
552	{
553	struct brcmf_sdio_dev *sdiodev;
554	struct sdio_func *func = dev_to_sdio_func(dev);
555
556	sdiodev = dev_get_drvdata(&func->card->dev);
557	brcmf_sdio_wdtmr_enable(sdiodev, true);
558	atomic_set(&sdiodev->suspend, false);
559	return 0;
560	}
561
562	static const struct dev_pm_ops brcmf_sdio_pm_ops = {
563	.suspend = brcmf_sdio_suspend,
564	.resume = brcmf_sdio_resume,
565	};
566	#endif /* CONFIG_PM_SLEEP */
567
568	static struct sdio_driver brcmf_sdmmc_driver = {
569	.probe = brcmf_ops_sdio_probe,
570	.remove = brcmf_ops_sdio_remove,
571	.name = "brcmfmac",
572	.id_table = brcmf_sdmmc_ids,
573	#ifdef CONFIG_PM_SLEEP
574	.drv = {
575	.pm = &brcmf_sdio_pm_ops,
576	},
577	#endif /* CONFIG_PM_SLEEP */
578	};
579
580	/* bus register interface */
581	int brcmf_bus_register(void)
582	{
583	brcmf_dbg(TRACE, "Enter\n");
584
585	return sdio_register_driver(&brcmf_sdmmc_driver);
586	}
587
588	void brcmf_bus_unregister(void)
589	{
590	brcmf_dbg(TRACE, "Enter\n");
591
592	sdio_unregister_driver(&brcmf_sdmmc_driver);
593	}