[linux-2.6-block.git] / drivers / net / wireless / iwmc3200wifi / sdio.c

/*
 * Intel Wireless Multicomm 3200 WiFi driver
 *
 * Copyright (C) 2009 Intel Corporation. All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 *   * Redistributions of source code must retain the above copyright
 *     notice, this list of conditions and the following disclaimer.
 *   * Redistributions in binary form must reproduce the above copyright
 *     notice, this list of conditions and the following disclaimer in
 *     the documentation and/or other materials provided with the
 *     distribution.
 *   * Neither the name of Intel Corporation nor the names of its
 *     contributors may be used to endorse or promote products derived
 *     from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 *
 *
 * Intel Corporation <ilw@linux.intel.com>
 * Samuel Ortiz <samuel.ortiz@intel.com>
 * Zhu Yi <yi.zhu@intel.com>
 *
 */

/*
 * This is the SDIO bus specific hooks for iwm.
 * It also is the module's entry point.
 *
 * Interesting code paths:
 * iwm_sdio_probe() (Called by an SDIO bus scan)
 *  -> iwm_if_alloc() (netdev.c)
 *      -> iwm_wdev_alloc() (cfg80211.c, allocates and register our wiphy)
 *          -> wiphy_new()
 *          -> wiphy_register()
 *      -> alloc_netdev_mq()
 *      -> register_netdev()
 *
 * iwm_sdio_remove()
 *  -> iwm_if_free() (netdev.c)
 *      -> unregister_netdev()
 *      -> iwm_wdev_free() (cfg80211.c)
 *          -> wiphy_unregister()
 *          -> wiphy_free()
 *
 * iwm_sdio_isr() (called in process context from the SDIO core code)
 *  -> queue_work(.., isr_worker)
 *      -- [async] --> iwm_sdio_isr_worker()
 *                      -> iwm_rx_handle()
 */

#include <linux/kernel.h>
#include <linux/slab.h>
#include <linux/netdevice.h>
#include <linux/debugfs.h>
#include <linux/mmc/sdio_ids.h>
#include <linux/mmc/sdio.h>
#include <linux/mmc/sdio_func.h>

#include "iwm.h"
#include "debug.h"
#include "bus.h"
#include "sdio.h"

static void iwm_sdio_isr_worker(struct work_struct *work)
{
	struct iwm_sdio_priv *hw;
	struct iwm_priv *iwm;
	struct iwm_rx_info *rx_info;
	struct sk_buff *skb;
	u8 *rx_buf;
	unsigned long rx_size;

	hw = container_of(work, struct iwm_sdio_priv, isr_worker);
	iwm = hw_to_iwm(hw);

	while (!skb_queue_empty(&iwm->rx_list)) {
		skb = skb_dequeue(&iwm->rx_list);
		rx_info = skb_to_rx_info(skb);
		rx_size = rx_info->rx_size;
		rx_buf = skb->data;

		IWM_HEXDUMP(iwm, DBG, SDIO, "RX: ", rx_buf, rx_size);
		if (iwm_rx_handle(iwm, rx_buf, rx_size) < 0)
			IWM_WARN(iwm, "RX error\n");

		kfree_skb(skb);
	}
}

static void iwm_sdio_isr(struct sdio_func *func)
{
	struct iwm_priv *iwm;
	struct iwm_sdio_priv *hw;
	struct iwm_rx_info *rx_info;
	struct sk_buff *skb;
	unsigned long buf_size, read_size;
	int ret;
	u8 val;

	hw = sdio_get_drvdata(func);
	iwm = hw_to_iwm(hw);

	buf_size = hw->blk_size;

	/* We're checking the status */
	val = sdio_readb(func, IWM_SDIO_INTR_STATUS_ADDR, &ret);
	if (val == 0 || ret < 0) {
		IWM_ERR(iwm, "Wrong INTR_STATUS\n");
		return;
	}

	/* See if we have free buffers */
	if (skb_queue_len(&iwm->rx_list) > IWM_RX_LIST_SIZE) {
		IWM_ERR(iwm, "No buffer for more Rx frames\n");
		return;
	}

	/* We first read the transaction size */
	read_size = sdio_readb(func, IWM_SDIO_INTR_GET_SIZE_ADDR + 1, &ret);
	read_size = read_size << 8;

	if (ret < 0) {
		IWM_ERR(iwm, "Couldn't read the xfer size\n");
		return;
	}

	/* We need to clear the INT register */
	sdio_writeb(func, 1, IWM_SDIO_INTR_CLEAR_ADDR, &ret);
	if (ret < 0) {
		IWM_ERR(iwm, "Couldn't clear the INT register\n");
		return;
	}

	while (buf_size < read_size)
		buf_size <<= 1;

	skb = dev_alloc_skb(buf_size);
	if (!skb) {
		IWM_ERR(iwm, "Couldn't alloc RX skb\n");
		return;
	}
	rx_info = skb_to_rx_info(skb);
	rx_info->rx_size = read_size;
	rx_info->rx_buf_size = buf_size;

	/* Now we can read the actual buffer */
	ret = sdio_memcpy_fromio(func, skb_put(skb, read_size),
				 IWM_SDIO_DATA_ADDR, read_size);

	/* The skb is put on a driver's specific Rx SKB list */
	skb_queue_tail(&iwm->rx_list, skb);

	/* We can now schedule the actual worker */
	queue_work(hw->isr_wq, &hw->isr_worker);
}

static void iwm_sdio_rx_free(struct iwm_sdio_priv *hw)
{
	struct iwm_priv *iwm = hw_to_iwm(hw);

	flush_workqueue(hw->isr_wq);

	skb_queue_purge(&iwm->rx_list);
}

/* Bus ops */
static int if_sdio_enable(struct iwm_priv *iwm)
{
	struct iwm_sdio_priv *hw = iwm_to_if_sdio(iwm);
	int ret;

	sdio_claim_host(hw->func);

	ret = sdio_enable_func(hw->func);
	if (ret) {
		IWM_ERR(iwm, "Couldn't enable the device: is TOP driver "
			"loaded and functional?\n");
		goto release_host;
	}

	iwm_reset(iwm);

	ret = sdio_claim_irq(hw->func, iwm_sdio_isr);
	if (ret) {
		IWM_ERR(iwm, "Failed to claim irq: %d\n", ret);
		goto release_host;
	}

	sdio_writeb(hw->func, 1, IWM_SDIO_INTR_ENABLE_ADDR, &ret);
	if (ret < 0) {
		IWM_ERR(iwm, "Couldn't enable INTR: %d\n", ret);
		goto release_irq;
	}

	sdio_release_host(hw->func);

	IWM_DBG_SDIO(iwm, INFO, "IWM SDIO enable\n");

	return 0;

 release_irq:
	sdio_release_irq(hw->func);
 release_host:
	sdio_release_host(hw->func);

	return ret;
}

static int if_sdio_disable(struct iwm_priv *iwm)
{
	struct iwm_sdio_priv *hw = iwm_to_if_sdio(iwm);
	int ret;

	sdio_claim_host(hw->func);
	sdio_writeb(hw->func, 0, IWM_SDIO_INTR_ENABLE_ADDR, &ret);
	if (ret < 0)
		IWM_WARN(iwm, "Couldn't disable INTR: %d\n", ret);

	sdio_release_irq(hw->func);
	sdio_disable_func(hw->func);
	sdio_release_host(hw->func);

	iwm_sdio_rx_free(hw);

	iwm_reset(iwm);

	IWM_DBG_SDIO(iwm, INFO, "IWM SDIO disable\n");

	return 0;
}

static int if_sdio_send_chunk(struct iwm_priv *iwm, u8 *buf, int count)
{
	struct iwm_sdio_priv *hw = iwm_to_if_sdio(iwm);
	int aligned_count = ALIGN(count, hw->blk_size);
	int ret;

	if ((unsigned long)buf & 0x3) {
		IWM_ERR(iwm, "buf <%p> is not dword aligned\n", buf);
		/* TODO: Is this a hardware limitation? use get_unligned */
		return -EINVAL;
	}

	sdio_claim_host(hw->func);
	ret = sdio_memcpy_toio(hw->func, IWM_SDIO_DATA_ADDR, buf,
			       aligned_count);
	sdio_release_host(hw->func);

	return ret;
}

/* debugfs hooks */
static int iwm_debugfs_sdio_open(struct inode *inode, struct file *filp)
{
	filp->private_data = inode->i_private;
	return 0;
}

static ssize_t iwm_debugfs_sdio_read(struct file *filp, char __user *buffer,
				     size_t count, loff_t *ppos)
{
	struct iwm_priv *iwm = filp->private_data;
	struct iwm_sdio_priv *hw = iwm_to_if_sdio(iwm);
	char *buf;
	u8 cccr;
	int buf_len = 4096, ret;
	size_t len = 0;

	if (*ppos != 0)
		return 0;
	if (count < sizeof(buf))
		return -ENOSPC;

	buf = kzalloc(buf_len, GFP_KERNEL);
	if (!buf)
		return -ENOMEM;

	sdio_claim_host(hw->func);

	cccr =  sdio_f0_readb(hw->func, SDIO_CCCR_IOEx, &ret);
	if (ret) {
		IWM_ERR(iwm, "Could not read SDIO_CCCR_IOEx\n");
		goto err;
	}
	len += snprintf(buf + len, buf_len - len, "CCCR_IOEx:  0x%x\n", cccr);

	cccr =  sdio_f0_readb(hw->func, SDIO_CCCR_IORx, &ret);
	if (ret) {
		IWM_ERR(iwm, "Could not read SDIO_CCCR_IORx\n");
		goto err;
	}
	len += snprintf(buf + len, buf_len - len, "CCCR_IORx:  0x%x\n", cccr);


	cccr =  sdio_f0_readb(hw->func, SDIO_CCCR_IENx, &ret);
	if (ret) {
		IWM_ERR(iwm, "Could not read SDIO_CCCR_IENx\n");
		goto err;
	}
	len += snprintf(buf + len, buf_len - len, "CCCR_IENx:  0x%x\n", cccr);


	cccr =  sdio_f0_readb(hw->func, SDIO_CCCR_INTx, &ret);
	if (ret) {
		IWM_ERR(iwm, "Could not read SDIO_CCCR_INTx\n");
		goto err;
	}
	len += snprintf(buf + len, buf_len - len, "CCCR_INTx:  0x%x\n", cccr);


	cccr =  sdio_f0_readb(hw->func, SDIO_CCCR_ABORT, &ret);
	if (ret) {
		IWM_ERR(iwm, "Could not read SDIO_CCCR_ABORTx\n");
		goto err;
	}
	len += snprintf(buf + len, buf_len - len, "CCCR_ABORT: 0x%x\n", cccr);

	cccr =  sdio_f0_readb(hw->func, SDIO_CCCR_IF, &ret);
	if (ret) {
		IWM_ERR(iwm, "Could not read SDIO_CCCR_IF\n");
		goto err;
	}
	len += snprintf(buf + len, buf_len - len, "CCCR_IF:    0x%x\n", cccr);


	cccr =  sdio_f0_readb(hw->func, SDIO_CCCR_CAPS, &ret);
	if (ret) {
		IWM_ERR(iwm, "Could not read SDIO_CCCR_CAPS\n");
		goto err;
	}
	len += snprintf(buf + len, buf_len - len, "CCCR_CAPS:  0x%x\n", cccr);

	cccr =  sdio_f0_readb(hw->func, SDIO_CCCR_CIS, &ret);
	if (ret) {
		IWM_ERR(iwm, "Could not read SDIO_CCCR_CIS\n");
		goto err;
	}
	len += snprintf(buf + len, buf_len - len, "CCCR_CIS:   0x%x\n", cccr);

	ret = simple_read_from_buffer(buffer, len, ppos, buf, buf_len);
err:
	sdio_release_host(hw->func);

	kfree(buf);

	return ret;
}

static const struct file_operations iwm_debugfs_sdio_fops = {
	.owner =	THIS_MODULE,
	.open =		iwm_debugfs_sdio_open,
	.read =		iwm_debugfs_sdio_read,
	.llseek =	default_llseek,
};

static void if_sdio_debugfs_init(struct iwm_priv *iwm, struct dentry *parent_dir)
{
	struct iwm_sdio_priv *hw = iwm_to_if_sdio(iwm);

	hw->cccr_dentry = debugfs_create_file("cccr", 0200,
					      parent_dir, iwm,
					      &iwm_debugfs_sdio_fops);
}

static void if_sdio_debugfs_exit(struct iwm_priv *iwm)
{
	struct iwm_sdio_priv *hw = iwm_to_if_sdio(iwm);

	debugfs_remove(hw->cccr_dentry);
}

static struct iwm_if_ops if_sdio_ops = {
	.enable = if_sdio_enable,
	.disable = if_sdio_disable,
	.send_chunk = if_sdio_send_chunk,
	.debugfs_init = if_sdio_debugfs_init,
	.debugfs_exit = if_sdio_debugfs_exit,
	.umac_name = "iwmc3200wifi-umac-sdio.bin",
	.calib_lmac_name = "iwmc3200wifi-calib-sdio.bin",
	.lmac_name = "iwmc3200wifi-lmac-sdio.bin",
};
MODULE_FIRMWARE("iwmc3200wifi-umac-sdio.bin");
MODULE_FIRMWARE("iwmc3200wifi-calib-sdio.bin");
MODULE_FIRMWARE("iwmc3200wifi-lmac-sdio.bin");

static int iwm_sdio_probe(struct sdio_func *func,
			  const struct sdio_device_id *id)
{
	struct iwm_priv *iwm;
	struct iwm_sdio_priv *hw;
	struct device *dev = &func->dev;
	int ret;

	/* check if TOP has already initialized the card */
	sdio_claim_host(func);
	ret = sdio_enable_func(func);
	if (ret) {
		dev_err(dev, "wait for TOP to enable the device\n");
		sdio_release_host(func);
		return ret;
	}

	ret = sdio_set_block_size(func, IWM_SDIO_BLK_SIZE);

	sdio_disable_func(func);
	sdio_release_host(func);

	if (ret < 0) {
		dev_err(dev, "Failed to set block size: %d\n", ret);
		return ret;
	}

	iwm = iwm_if_alloc(sizeof(struct iwm_sdio_priv), dev, &if_sdio_ops);
	if (IS_ERR(iwm)) {
		dev_err(dev, "allocate SDIO interface failed\n");
		return PTR_ERR(iwm);
	}

	hw = iwm_private(iwm);
	hw->iwm = iwm;

	iwm_debugfs_init(iwm);

	sdio_set_drvdata(func, hw);

	hw->func = func;
	hw->blk_size = IWM_SDIO_BLK_SIZE;

	hw->isr_wq = create_singlethread_workqueue(KBUILD_MODNAME "_sdio");
	if (!hw->isr_wq) {
		ret = -ENOMEM;
		goto debugfs_exit;
	}

	INIT_WORK(&hw->isr_worker, iwm_sdio_isr_worker);

	ret = iwm_if_add(iwm);
	if (ret) {
		dev_err(dev, "add SDIO interface failed\n");
		goto destroy_wq;
	}

	dev_info(dev, "IWM SDIO probe\n");

	return 0;

 destroy_wq:
	destroy_workqueue(hw->isr_wq);
 debugfs_exit:
	iwm_debugfs_exit(iwm);
	iwm_if_free(iwm);
	return ret;
}

static void iwm_sdio_remove(struct sdio_func *func)
{
	struct iwm_sdio_priv *hw = sdio_get_drvdata(func);
	struct iwm_priv *iwm = hw_to_iwm(hw);
	struct device *dev = &func->dev;

	iwm_if_remove(iwm);
	destroy_workqueue(hw->isr_wq);
	iwm_debugfs_exit(iwm);
	iwm_if_free(iwm);

	sdio_set_drvdata(func, NULL);

	dev_info(dev, "IWM SDIO remove\n");
}

static const struct sdio_device_id iwm_sdio_ids[] = {
	/* Global/AGN SKU */
	{ SDIO_DEVICE(SDIO_VENDOR_ID_INTEL, 0x1403) },
	/* BGN SKU */
	{ SDIO_DEVICE(SDIO_VENDOR_ID_INTEL, 0x1408) },
	{ /* end: all zeroes */	},
};
MODULE_DEVICE_TABLE(sdio, iwm_sdio_ids);

static struct sdio_driver iwm_sdio_driver = {
	.name		= "iwm_sdio",
	.id_table	= iwm_sdio_ids,
	.probe		= iwm_sdio_probe,
	.remove		= iwm_sdio_remove,
};

static int __init iwm_sdio_init_module(void)
{
	return sdio_register_driver(&iwm_sdio_driver);
}

static void __exit iwm_sdio_exit_module(void)
{
	sdio_unregister_driver(&iwm_sdio_driver);
}

module_init(iwm_sdio_init_module);
module_exit(iwm_sdio_exit_module);

MODULE_LICENSE("GPL");
MODULE_AUTHOR(IWM_COPYRIGHT " " IWM_AUTHOR);
Commit	Line	Data
bb9f8692 ZY	1	/*
	2	* Intel Wireless Multicomm 3200 WiFi driver
	3	*
	4	* Copyright (C) 2009 Intel Corporation. All rights reserved.
	5	*
	6	* Redistribution and use in source and binary forms, with or without
	7	* modification, are permitted provided that the following conditions
	8	* are met:
	9	*
	10	* * Redistributions of source code must retain the above copyright
	11	* notice, this list of conditions and the following disclaimer.
	12	* * Redistributions in binary form must reproduce the above copyright
	13	* notice, this list of conditions and the following disclaimer in
	14	* the documentation and/or other materials provided with the
	15	* distribution.
	16	* * Neither the name of Intel Corporation nor the names of its
	17	* contributors may be used to endorse or promote products derived
	18	* from this software without specific prior written permission.
	19	*
	20	* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
	21	* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
	22	* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
	23	* A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
	24	* OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
	25	* SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
	26	* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
	27	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
	28	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
	29	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
	30	* OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
	31	*
	32	*
	33	* Intel Corporation <ilw@linux.intel.com>
	34	* Samuel Ortiz <samuel.ortiz@intel.com>
	35	* Zhu Yi <yi.zhu@intel.com>
	36	*
	37	*/
	38
	39	/*
	40	* This is the SDIO bus specific hooks for iwm.
	41	* It also is the module's entry point.
	42	*
	43	* Interesting code paths:
	44	* iwm_sdio_probe() (Called by an SDIO bus scan)
	45	* -> iwm_if_alloc() (netdev.c)
	46	* -> iwm_wdev_alloc() (cfg80211.c, allocates and register our wiphy)
	47	* -> wiphy_new()
	48	* -> wiphy_register()
	49	* -> alloc_netdev_mq()
	50	* -> register_netdev()
	51	*
	52	* iwm_sdio_remove()
	53	* -> iwm_if_free() (netdev.c)
	54	* -> unregister_netdev()
	55	* -> iwm_wdev_free() (cfg80211.c)
	56	* -> wiphy_unregister()
	57	* -> wiphy_free()
	58	*
	59	* iwm_sdio_isr() (called in process context from the SDIO core code)
	60	* -> queue_work(.., isr_worker)
	61	* -- [async] --> iwm_sdio_isr_worker()
	62	* -> iwm_rx_handle()
	63	*/
	64
65	#include <linux/kernel.h>
5a0e3ad6	66	#include <linux/slab.h>
bb9f8692 ZY	67	#include <linux/netdevice.h>
bb9f8692 ZY	68	#include <linux/debugfs.h>
51def0be	69	#include <linux/mmc/sdio_ids.h>
bb9f8692 ZY	70	#include <linux/mmc/sdio.h>
	71	#include <linux/mmc/sdio_func.h>
	72
	73	#include "iwm.h"
	74	#include "debug.h"
	75	#include "bus.h"
	76	#include "sdio.h"
	77
	78	static void iwm_sdio_isr_worker(struct work_struct *work)
	79	{
	80	struct iwm_sdio_priv *hw;
	81	struct iwm_priv *iwm;
	82	struct iwm_rx_info *rx_info;
	83	struct sk_buff *skb;
	84	u8 *rx_buf;
	85	unsigned long rx_size;
	86
	87	hw = container_of(work, struct iwm_sdio_priv, isr_worker);
	88	iwm = hw_to_iwm(hw);
	89
	90	while (!skb_queue_empty(&iwm->rx_list)) {
	91	skb = skb_dequeue(&iwm->rx_list);
	92	rx_info = skb_to_rx_info(skb);
	93	rx_size = rx_info->rx_size;
	94	rx_buf = skb->data;
	95
	96	IWM_HEXDUMP(iwm, DBG, SDIO, "RX: ", rx_buf, rx_size);
	97	if (iwm_rx_handle(iwm, rx_buf, rx_size) < 0)
	98	IWM_WARN(iwm, "RX error\n");
	99
	100	kfree_skb(skb);
	101	}
	102	}
	103
	104	static void iwm_sdio_isr(struct sdio_func *func)
	105	{
	106	struct iwm_priv *iwm;
	107	struct iwm_sdio_priv *hw;
	108	struct iwm_rx_info *rx_info;
	109	struct sk_buff *skb;
	110	unsigned long buf_size, read_size;
	111	int ret;
	112	u8 val;
	113
	114	hw = sdio_get_drvdata(func);
	115	iwm = hw_to_iwm(hw);
	116
	117	buf_size = hw->blk_size;
	118
	119	/* We're checking the status */
	120	val = sdio_readb(func, IWM_SDIO_INTR_STATUS_ADDR, &ret);
	121	if (val == 0 \|\| ret < 0) {
	122	IWM_ERR(iwm, "Wrong INTR_STATUS\n");
	123	return;
	124	}
	125
	126	/* See if we have free buffers */
	127	if (skb_queue_len(&iwm->rx_list) > IWM_RX_LIST_SIZE) {
	128	IWM_ERR(iwm, "No buffer for more Rx frames\n");
	129	return;
	130	}
	131
	132	/* We first read the transaction size */
	133	read_size = sdio_readb(func, IWM_SDIO_INTR_GET_SIZE_ADDR + 1, &ret);
134	read_size = read_size << 8;
135
136	if (ret < 0) {
137	IWM_ERR(iwm, "Couldn't read the xfer size\n");
138	return;
139	}
140
141	/* We need to clear the INT register */
142	sdio_writeb(func, 1, IWM_SDIO_INTR_CLEAR_ADDR, &ret);
143	if (ret < 0) {
144	IWM_ERR(iwm, "Couldn't clear the INT register\n");
145	return;
146	}
147
148	while (buf_size < read_size)
149	buf_size <<= 1;
150
151	skb = dev_alloc_skb(buf_size);
152	if (!skb) {
153	IWM_ERR(iwm, "Couldn't alloc RX skb\n");
154	return;
155	}
156	rx_info = skb_to_rx_info(skb);
157	rx_info->rx_size = read_size;
158	rx_info->rx_buf_size = buf_size;
159
160	/* Now we can read the actual buffer */
161	ret = sdio_memcpy_fromio(func, skb_put(skb, read_size),
162	IWM_SDIO_DATA_ADDR, read_size);
163
164	/* The skb is put on a driver's specific Rx SKB list */
165	skb_queue_tail(&iwm->rx_list, skb);
166
167	/* We can now schedule the actual worker */
168	queue_work(hw->isr_wq, &hw->isr_worker);
169	}
170
171	static void iwm_sdio_rx_free(struct iwm_sdio_priv *hw)
172	{
173	struct iwm_priv *iwm = hw_to_iwm(hw);
174
175	flush_workqueue(hw->isr_wq);
176
177	skb_queue_purge(&iwm->rx_list);
178	}
179
180	/* Bus ops */
181	static int if_sdio_enable(struct iwm_priv *iwm)
182	{
183	struct iwm_sdio_priv *hw = iwm_to_if_sdio(iwm);
184	int ret;
185
186	sdio_claim_host(hw->func);
187
188	ret = sdio_enable_func(hw->func);
189	if (ret) {
190	IWM_ERR(iwm, "Couldn't enable the device: is TOP driver "
191	"loaded and functional?\n");
192	goto release_host;
193	}
194
195	iwm_reset(iwm);
196
197	ret = sdio_claim_irq(hw->func, iwm_sdio_isr);
198	if (ret) {
199	IWM_ERR(iwm, "Failed to claim irq: %d\n", ret);
200	goto release_host;
201	}
202
203	sdio_writeb(hw->func, 1, IWM_SDIO_INTR_ENABLE_ADDR, &ret);
204	if (ret < 0) {
205	IWM_ERR(iwm, "Couldn't enable INTR: %d\n", ret);
206	goto release_irq;
207	}
208
209	sdio_release_host(hw->func);
210
211	IWM_DBG_SDIO(iwm, INFO, "IWM SDIO enable\n");
212
213	return 0;
214
215	release_irq:
216	sdio_release_irq(hw->func);
217	release_host:
218	sdio_release_host(hw->func);
219
220	return ret;
221	}
222
223	static int if_sdio_disable(struct iwm_priv *iwm)
224	{
225	struct iwm_sdio_priv *hw = iwm_to_if_sdio(iwm);
226	int ret;
227
bb9f8692 ZY	228	sdio_claim_host(hw->func);
	229	sdio_writeb(hw->func, 0, IWM_SDIO_INTR_ENABLE_ADDR, &ret);
	230	if (ret < 0)
	231	IWM_WARN(iwm, "Couldn't disable INTR: %d\n", ret);
	232
	233	sdio_release_irq(hw->func);
	234	sdio_disable_func(hw->func);
	235	sdio_release_host(hw->func);
	236
	237	iwm_sdio_rx_free(hw);
	238
f96cca84 SO	239	iwm_reset(iwm);
f96cca84 SO	240
bb9f8692 ZY	241	IWM_DBG_SDIO(iwm, INFO, "IWM SDIO disable\n");
	242
	243	return 0;
	244	}
	245
	246	static int if_sdio_send_chunk(struct iwm_priv iwm, u8 buf, int count)
	247	{
	248	struct iwm_sdio_priv *hw = iwm_to_if_sdio(iwm);
	249	int aligned_count = ALIGN(count, hw->blk_size);
	250	int ret;
	251
	252	if ((unsigned long)buf & 0x3) {
	253	IWM_ERR(iwm, "buf <%p> is not dword aligned\n", buf);
	254	/* TODO: Is this a hardware limitation? use get_unligned */
	255	return -EINVAL;
	256	}
	257
	258	sdio_claim_host(hw->func);
	259	ret = sdio_memcpy_toio(hw->func, IWM_SDIO_DATA_ADDR, buf,
	260	aligned_count);
	261	sdio_release_host(hw->func);
	262
	263	return ret;
	264	}
	265
	266	/* debugfs hooks */
	267	static int iwm_debugfs_sdio_open(struct inode inode, struct file filp)
	268	{
	269	filp->private_data = inode->i_private;
	270	return 0;
	271	}
	272
	273	static ssize_t iwm_debugfs_sdio_read(struct file filp, char __user buffer,
	274	size_t count, loff_t *ppos)
	275	{
	276	struct iwm_priv *iwm = filp->private_data;
	277	struct iwm_sdio_priv *hw = iwm_to_if_sdio(iwm);
	278	char *buf;
	279	u8 cccr;
	280	int buf_len = 4096, ret;
	281	size_t len = 0;
	282
	283	if (*ppos != 0)
	284	return 0;
	285	if (count < sizeof(buf))
	286	return -ENOSPC;
	287
	288	buf = kzalloc(buf_len, GFP_KERNEL);
	289	if (!buf)
	290	return -ENOMEM;
	291
	292	sdio_claim_host(hw->func);
	293
	294	cccr = sdio_f0_readb(hw->func, SDIO_CCCR_IOEx, &ret);
	295	if (ret) {
	296	IWM_ERR(iwm, "Could not read SDIO_CCCR_IOEx\n");
	297	goto err;
	298	}
	299	len += snprintf(buf + len, buf_len - len, "CCCR_IOEx: 0x%x\n", cccr);
	300
	301	cccr = sdio_f0_readb(hw->func, SDIO_CCCR_IORx, &ret);
	302	if (ret) {
	303	IWM_ERR(iwm, "Could not read SDIO_CCCR_IORx\n");
	304	goto err;
305	}
306	len += snprintf(buf + len, buf_len - len, "CCCR_IORx: 0x%x\n", cccr);
307
308
309	cccr = sdio_f0_readb(hw->func, SDIO_CCCR_IENx, &ret);
310	if (ret) {
311	IWM_ERR(iwm, "Could not read SDIO_CCCR_IENx\n");
312	goto err;
313	}
314	len += snprintf(buf + len, buf_len - len, "CCCR_IENx: 0x%x\n", cccr);
315
316
317	cccr = sdio_f0_readb(hw->func, SDIO_CCCR_INTx, &ret);
318	if (ret) {
319	IWM_ERR(iwm, "Could not read SDIO_CCCR_INTx\n");
320	goto err;
321	}
322	len += snprintf(buf + len, buf_len - len, "CCCR_INTx: 0x%x\n", cccr);
323
324
325	cccr = sdio_f0_readb(hw->func, SDIO_CCCR_ABORT, &ret);
326	if (ret) {
327	IWM_ERR(iwm, "Could not read SDIO_CCCR_ABORTx\n");
328	goto err;
329	}
330	len += snprintf(buf + len, buf_len - len, "CCCR_ABORT: 0x%x\n", cccr);
331
332	cccr = sdio_f0_readb(hw->func, SDIO_CCCR_IF, &ret);
333	if (ret) {
334	IWM_ERR(iwm, "Could not read SDIO_CCCR_IF\n");
335	goto err;
336	}
337	len += snprintf(buf + len, buf_len - len, "CCCR_IF: 0x%x\n", cccr);
338
339
340	cccr = sdio_f0_readb(hw->func, SDIO_CCCR_CAPS, &ret);
341	if (ret) {
342	IWM_ERR(iwm, "Could not read SDIO_CCCR_CAPS\n");
343	goto err;
344	}
345	len += snprintf(buf + len, buf_len - len, "CCCR_CAPS: 0x%x\n", cccr);
346
347	cccr = sdio_f0_readb(hw->func, SDIO_CCCR_CIS, &ret);
348	if (ret) {
349	IWM_ERR(iwm, "Could not read SDIO_CCCR_CIS\n");
350	goto err;
351	}
352	len += snprintf(buf + len, buf_len - len, "CCCR_CIS: 0x%x\n", cccr);
353
354	ret = simple_read_from_buffer(buffer, len, ppos, buf, buf_len);
355	err:
356	sdio_release_host(hw->func);
357
358	kfree(buf);
359
360	return ret;
361	}
362
363	static const struct file_operations iwm_debugfs_sdio_fops = {
364	.owner = THIS_MODULE,
365	.open = iwm_debugfs_sdio_open,
366	.read = iwm_debugfs_sdio_read,
6038f373	367	.llseek = default_llseek,
bb9f8692 ZY	368	};
bb9f8692 ZY	369
1f55c12c	370	static void if_sdio_debugfs_init(struct iwm_priv iwm, struct dentry parent_dir)
bb9f8692	371	{
bb9f8692 ZY	372	struct iwm_sdio_priv *hw = iwm_to_if_sdio(iwm);
	373
	374	hw->cccr_dentry = debugfs_create_file("cccr", 0200,
	375	parent_dir, iwm,
	376	&iwm_debugfs_sdio_fops);
bb9f8692 ZY	377	}
	378
	379	static void if_sdio_debugfs_exit(struct iwm_priv *iwm)
	380	{
	381	struct iwm_sdio_priv *hw = iwm_to_if_sdio(iwm);
	382
	383	debugfs_remove(hw->cccr_dentry);
	384	}
	385
	386	static struct iwm_if_ops if_sdio_ops = {
	387	.enable = if_sdio_enable,
	388	.disable = if_sdio_disable,
	389	.send_chunk = if_sdio_send_chunk,
	390	.debugfs_init = if_sdio_debugfs_init,
	391	.debugfs_exit = if_sdio_debugfs_exit,
	392	.umac_name = "iwmc3200wifi-umac-sdio.bin",
939cab83	393	.calib_lmac_name = "iwmc3200wifi-calib-sdio.bin",
bb9f8692 ZY	394	.lmac_name = "iwmc3200wifi-lmac-sdio.bin",
bb9f8692 ZY	395	};
328aca32 BH	396	MODULE_FIRMWARE("iwmc3200wifi-umac-sdio.bin");
	397	MODULE_FIRMWARE("iwmc3200wifi-calib-sdio.bin");
	398	MODULE_FIRMWARE("iwmc3200wifi-lmac-sdio.bin");
bb9f8692 ZY	399
	400	static int iwm_sdio_probe(struct sdio_func *func,
	401	const struct sdio_device_id *id)
	402	{
	403	struct iwm_priv *iwm;
	404	struct iwm_sdio_priv *hw;
	405	struct device *dev = &func->dev;
	406	int ret;
	407
	408	/* check if TOP has already initialized the card */
	409	sdio_claim_host(func);
	410	ret = sdio_enable_func(func);
	411	if (ret) {
	412	dev_err(dev, "wait for TOP to enable the device\n");
	413	sdio_release_host(func);
	414	return ret;
	415	}
	416
	417	ret = sdio_set_block_size(func, IWM_SDIO_BLK_SIZE);
	418
	419	sdio_disable_func(func);
	420	sdio_release_host(func);
	421
	422	if (ret < 0) {
	423	dev_err(dev, "Failed to set block size: %d\n", ret);
	424	return ret;
	425	}
	426
	427	iwm = iwm_if_alloc(sizeof(struct iwm_sdio_priv), dev, &if_sdio_ops);
	428	if (IS_ERR(iwm)) {
	429	dev_err(dev, "allocate SDIO interface failed\n");
	430	return PTR_ERR(iwm);
	431	}
	432
	433	hw = iwm_private(iwm);
	434	hw->iwm = iwm;
	435
1f55c12c	436	iwm_debugfs_init(iwm);
bb9f8692 ZY	437
	438	sdio_set_drvdata(func, hw);
	439
	440	hw->func = func;
	441	hw->blk_size = IWM_SDIO_BLK_SIZE;
	442
	443	hw->isr_wq = create_singlethread_workqueue(KBUILD_MODNAME "_sdio");
	444	if (!hw->isr_wq) {
	445	ret = -ENOMEM;
	446	goto debugfs_exit;
	447	}
	448
	449	INIT_WORK(&hw->isr_worker, iwm_sdio_isr_worker);
	450
d7e057dc ZY	451	ret = iwm_if_add(iwm);
	452	if (ret) {
	453	dev_err(dev, "add SDIO interface failed\n");
	454	goto destroy_wq;
	455	}
	456
bb9f8692 ZY	457	dev_info(dev, "IWM SDIO probe\n");
	458
	459	return 0;
	460
d7e057dc ZY	461	destroy_wq:
d7e057dc ZY	462	destroy_workqueue(hw->isr_wq);
bb9f8692 ZY	463	debugfs_exit:
bb9f8692 ZY	464	iwm_debugfs_exit(iwm);
bb9f8692 ZY	465	iwm_if_free(iwm);
	466	return ret;
	467	}
	468
	469	static void iwm_sdio_remove(struct sdio_func *func)
	470	{
	471	struct iwm_sdio_priv *hw = sdio_get_drvdata(func);
	472	struct iwm_priv *iwm = hw_to_iwm(hw);
	473	struct device *dev = &func->dev;
	474
d7e057dc	475	iwm_if_remove(iwm);
bb9f8692	476	destroy_workqueue(hw->isr_wq);
4e9aa52e ZY	477	iwm_debugfs_exit(iwm);
4e9aa52e ZY	478	iwm_if_free(iwm);
bb9f8692 ZY	479
	480	sdio_set_drvdata(func, NULL);
	481
	482	dev_info(dev, "IWM SDIO remove\n");
bb9f8692 ZY	483	}
	484
	485	static const struct sdio_device_id iwm_sdio_ids[] = {
30315ff0 ZY	486	/* Global/AGN SKU */
	487	{ SDIO_DEVICE(SDIO_VENDOR_ID_INTEL, 0x1403) },
	488	/* BGN SKU */
	489	{ SDIO_DEVICE(SDIO_VENDOR_ID_INTEL, 0x1408) },
bb9f8692 ZY	490	{ /* end: all zeroes */ },
	491	};
	492	MODULE_DEVICE_TABLE(sdio, iwm_sdio_ids);
	493
	494	static struct sdio_driver iwm_sdio_driver = {
	495	.name = "iwm_sdio",
	496	.id_table = iwm_sdio_ids,
	497	.probe = iwm_sdio_probe,
	498	.remove = iwm_sdio_remove,
	499	};
	500
	501	static int __init iwm_sdio_init_module(void)
	502	{
257862f3	503	return sdio_register_driver(&iwm_sdio_driver);
bb9f8692 ZY	504	}
	505
	506	static void __exit iwm_sdio_exit_module(void)
	507	{
	508	sdio_unregister_driver(&iwm_sdio_driver);
	509	}
	510
	511	module_init(iwm_sdio_init_module);
	512	module_exit(iwm_sdio_exit_module);
	513
	514	MODULE_LICENSE("GPL");
	515	MODULE_AUTHOR(IWM_COPYRIGHT " " IWM_AUTHOR);