262 lines
		
	
	
		
			6.7 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			262 lines
		
	
	
		
			6.7 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
/*
 | 
						|
 * BCMSDH Function Driver for the native SDIO/MMC driver in the Linux Kernel
 | 
						|
 *
 | 
						|
 * Copyright (C) 1999-2010, Broadcom Corporation
 | 
						|
 * 
 | 
						|
 *      Unless you and Broadcom execute a separate written software license
 | 
						|
 * agreement governing use of this software, this software is licensed to you
 | 
						|
 * under the terms of the GNU General Public License version 2 (the "GPL"),
 | 
						|
 * available at http://www.broadcom.com/licenses/GPLv2.php, with the
 | 
						|
 * following added to such license:
 | 
						|
 * 
 | 
						|
 *      As a special exception, the copyright holders of this software give you
 | 
						|
 * permission to link this software with independent modules, and to copy and
 | 
						|
 * distribute the resulting executable under terms of your choice, provided that
 | 
						|
 * you also meet, for each linked independent module, the terms and conditions of
 | 
						|
 * the license of that module.  An independent module is a module which is not
 | 
						|
 * derived from this software.  The special exception does not apply to any
 | 
						|
 * modifications of the software.
 | 
						|
 * 
 | 
						|
 *      Notwithstanding the above, under no circumstances may you combine this
 | 
						|
 * software in any way with any other Broadcom software provided under a license
 | 
						|
 * other than the GPL, without Broadcom's express prior written consent.
 | 
						|
 *
 | 
						|
 * $Id: bcmsdh_sdmmc_linux.c,v 1.1.2.5.6.15 2010/04/14 21:11:46 Exp $
 | 
						|
 */
 | 
						|
 | 
						|
#include <typedefs.h>
 | 
						|
#include <bcmutils.h>
 | 
						|
#include <sdio.h>	/* SDIO Specs */
 | 
						|
#include <bcmsdbus.h>	/* bcmsdh to/from specific controller APIs */
 | 
						|
#include <sdiovar.h>	/* to get msglevel bit values */
 | 
						|
 | 
						|
#include <linux/sched.h>	/* request_irq() */
 | 
						|
 | 
						|
#include <linux/mmc/core.h>
 | 
						|
#include <linux/mmc/card.h>
 | 
						|
#include <linux/mmc/sdio_func.h>
 | 
						|
#include <linux/mmc/sdio_ids.h>
 | 
						|
 | 
						|
#if !defined(SDIO_VENDOR_ID_BROADCOM)
 | 
						|
#define SDIO_VENDOR_ID_BROADCOM		0x02d0
 | 
						|
#endif /* !defined(SDIO_DEVICE_ID_BROADCOM_4325) */
 | 
						|
#if !defined(SDIO_DEVICE_ID_BROADCOM_4325)
 | 
						|
#define SDIO_DEVICE_ID_BROADCOM_4325	0x0000
 | 
						|
#endif /* !defined(SDIO_DEVICE_ID_BROADCOM_4325) */
 | 
						|
#if !defined(SDIO_DEVICE_ID_BROADCOM_4329)
 | 
						|
#define SDIO_DEVICE_ID_BROADCOM_4329	0x4329
 | 
						|
#endif /* !defined(SDIO_DEVICE_ID_BROADCOM_4329) */
 | 
						|
 | 
						|
#include <bcmsdh_sdmmc.h>
 | 
						|
 | 
						|
#include <dhd_dbg.h>
 | 
						|
 | 
						|
extern void sdioh_sdmmc_devintr_off(sdioh_info_t *sd);
 | 
						|
extern void sdioh_sdmmc_devintr_on(sdioh_info_t *sd);
 | 
						|
 | 
						|
int sdio_function_init(void);
 | 
						|
void sdio_function_cleanup(void);
 | 
						|
 | 
						|
#define DESCRIPTION "bcmsdh_sdmmc Driver"
 | 
						|
#define AUTHOR "Broadcom Corporation"
 | 
						|
 | 
						|
/* module param defaults */
 | 
						|
static int clockoverride = 0;
 | 
						|
 | 
						|
module_param(clockoverride, int, 0644);
 | 
						|
MODULE_PARM_DESC(clockoverride, "SDIO card clock override");
 | 
						|
 | 
						|
PBCMSDH_SDMMC_INSTANCE gInstance;
 | 
						|
 | 
						|
/* Maximum number of bcmsdh_sdmmc devices supported by driver */
 | 
						|
#define BCMSDH_SDMMC_MAX_DEVICES 1
 | 
						|
 | 
						|
extern int bcmsdh_probe(struct device *dev);
 | 
						|
extern int bcmsdh_remove(struct device *dev);
 | 
						|
struct device sdmmc_dev;
 | 
						|
 | 
						|
static int bcmsdh_sdmmc_probe(struct sdio_func *func,
 | 
						|
                              const struct sdio_device_id *id)
 | 
						|
{
 | 
						|
	int ret = 0;
 | 
						|
	static struct sdio_func sdio_func_0;
 | 
						|
	sd_trace(("bcmsdh_sdmmc: %s Enter\n", __FUNCTION__));
 | 
						|
	sd_trace(("sdio_bcmsdh: func->class=%x\n", func->class));
 | 
						|
	sd_trace(("sdio_vendor: 0x%04x\n", func->vendor));
 | 
						|
	sd_trace(("sdio_device: 0x%04x\n", func->device));
 | 
						|
	sd_trace(("Function#: 0x%04x\n", func->num));
 | 
						|
 | 
						|
	if (func->num == 1) {
 | 
						|
		sdio_func_0.num = 0;
 | 
						|
		sdio_func_0.card = func->card;
 | 
						|
		gInstance->func[0] = &sdio_func_0;
 | 
						|
		if(func->device == 0x4) { /* 4318 */
 | 
						|
			gInstance->func[2] = NULL;
 | 
						|
			sd_trace(("NIC found, calling bcmsdh_probe...\n"));
 | 
						|
			ret = bcmsdh_probe(&sdmmc_dev);
 | 
						|
		}
 | 
						|
	}
 | 
						|
 | 
						|
	gInstance->func[func->num] = func;
 | 
						|
 | 
						|
	if (func->num == 2) {
 | 
						|
		sd_trace(("F2 found, calling bcmsdh_probe...\n"));
 | 
						|
		ret = bcmsdh_probe(&sdmmc_dev);
 | 
						|
	}
 | 
						|
 | 
						|
	return ret;
 | 
						|
}
 | 
						|
 | 
						|
static void bcmsdh_sdmmc_remove(struct sdio_func *func)
 | 
						|
{
 | 
						|
	sd_trace(("bcmsdh_sdmmc: %s Enter\n", __FUNCTION__));
 | 
						|
	sd_info(("sdio_bcmsdh: func->class=%x\n", func->class));
 | 
						|
	sd_info(("sdio_vendor: 0x%04x\n", func->vendor));
 | 
						|
	sd_info(("sdio_device: 0x%04x\n", func->device));
 | 
						|
	sd_info(("Function#: 0x%04x\n", func->num));
 | 
						|
 | 
						|
	if (func->num == 2) {
 | 
						|
		sd_trace(("F2 found, calling bcmsdh_probe...\n"));
 | 
						|
		bcmsdh_remove(&sdmmc_dev);
 | 
						|
	}
 | 
						|
}
 | 
						|
 | 
						|
/* devices we support, null terminated */
 | 
						|
static const struct sdio_device_id bcmsdh_sdmmc_ids[] = {
 | 
						|
	{ SDIO_DEVICE(SDIO_VENDOR_ID_BROADCOM, SDIO_DEVICE_ID_BROADCOM_4325) },
 | 
						|
	{ SDIO_DEVICE(SDIO_VENDOR_ID_BROADCOM, SDIO_DEVICE_ID_BROADCOM_4329) },
 | 
						|
	{ /* end: all zeroes */				},
 | 
						|
};
 | 
						|
 | 
						|
MODULE_DEVICE_TABLE(sdio, bcmsdh_sdmmc_ids);
 | 
						|
 | 
						|
static struct sdio_driver bcmsdh_sdmmc_driver = {
 | 
						|
	.probe		= bcmsdh_sdmmc_probe,
 | 
						|
	.remove		= bcmsdh_sdmmc_remove,
 | 
						|
	.name		= "bcmsdh_sdmmc",
 | 
						|
	.id_table	= bcmsdh_sdmmc_ids,
 | 
						|
	};
 | 
						|
 | 
						|
struct sdos_info {
 | 
						|
	sdioh_info_t *sd;
 | 
						|
	spinlock_t lock;
 | 
						|
};
 | 
						|
 | 
						|
 | 
						|
int
 | 
						|
sdioh_sdmmc_osinit(sdioh_info_t *sd)
 | 
						|
{
 | 
						|
	struct sdos_info *sdos;
 | 
						|
 | 
						|
	sdos = (struct sdos_info*)MALLOC(sd->osh, sizeof(struct sdos_info));
 | 
						|
	sd->sdos_info = (void*)sdos;
 | 
						|
	if (sdos == NULL)
 | 
						|
		return BCME_NOMEM;
 | 
						|
 | 
						|
	sdos->sd = sd;
 | 
						|
	spin_lock_init(&sdos->lock);
 | 
						|
	return BCME_OK;
 | 
						|
}
 | 
						|
 | 
						|
void
 | 
						|
sdioh_sdmmc_osfree(sdioh_info_t *sd)
 | 
						|
{
 | 
						|
	struct sdos_info *sdos;
 | 
						|
	ASSERT(sd && sd->sdos_info);
 | 
						|
 | 
						|
	sdos = (struct sdos_info *)sd->sdos_info;
 | 
						|
	MFREE(sd->osh, sdos, sizeof(struct sdos_info));
 | 
						|
}
 | 
						|
 | 
						|
/* Interrupt enable/disable */
 | 
						|
SDIOH_API_RC
 | 
						|
sdioh_interrupt_set(sdioh_info_t *sd, bool enable)
 | 
						|
{
 | 
						|
	ulong flags;
 | 
						|
	struct sdos_info *sdos;
 | 
						|
 | 
						|
	sd_trace(("%s: %s\n", __FUNCTION__, enable ? "Enabling" : "Disabling"));
 | 
						|
 | 
						|
	sdos = (struct sdos_info *)sd->sdos_info;
 | 
						|
	ASSERT(sdos);
 | 
						|
 | 
						|
#if !defined(OOB_INTR_ONLY)
 | 
						|
	if (enable && !(sd->intr_handler && sd->intr_handler_arg)) {
 | 
						|
		sd_err(("%s: no handler registered, will not enable\n", __FUNCTION__));
 | 
						|
		return SDIOH_API_RC_FAIL;
 | 
						|
	}
 | 
						|
#endif /* !defined(OOB_INTR_ONLY) */
 | 
						|
 | 
						|
	/* Ensure atomicity for enable/disable calls */
 | 
						|
	spin_lock_irqsave(&sdos->lock, flags);
 | 
						|
 | 
						|
	sd->client_intr_enabled = enable;
 | 
						|
	if (enable) {
 | 
						|
		sdioh_sdmmc_devintr_on(sd);
 | 
						|
	} else {
 | 
						|
		sdioh_sdmmc_devintr_off(sd);
 | 
						|
	}
 | 
						|
 | 
						|
	spin_unlock_irqrestore(&sdos->lock, flags);
 | 
						|
 | 
						|
	return SDIOH_API_RC_SUCCESS;
 | 
						|
}
 | 
						|
 | 
						|
 | 
						|
#ifdef BCMSDH_MODULE
 | 
						|
static int __init
 | 
						|
bcmsdh_module_init(void)
 | 
						|
{
 | 
						|
	int error = 0;
 | 
						|
	sdio_function_init();
 | 
						|
	return error;
 | 
						|
}
 | 
						|
 | 
						|
static void __exit
 | 
						|
bcmsdh_module_cleanup(void)
 | 
						|
{
 | 
						|
	sdio_function_cleanup();
 | 
						|
}
 | 
						|
 | 
						|
module_init(bcmsdh_module_init);
 | 
						|
module_exit(bcmsdh_module_cleanup);
 | 
						|
 | 
						|
MODULE_LICENSE("GPL v2");
 | 
						|
MODULE_DESCRIPTION(DESCRIPTION);
 | 
						|
MODULE_AUTHOR(AUTHOR);
 | 
						|
 | 
						|
#endif /* BCMSDH_MODULE */
 | 
						|
/*
 | 
						|
 * module init
 | 
						|
*/
 | 
						|
int sdio_function_init(void)
 | 
						|
{
 | 
						|
	int error = 0;
 | 
						|
	sd_trace(("bcmsdh_sdmmc: %s Enter\n", __FUNCTION__));
 | 
						|
 | 
						|
	gInstance = kzalloc(sizeof(BCMSDH_SDMMC_INSTANCE), GFP_KERNEL);
 | 
						|
	if (!gInstance)
 | 
						|
		return -ENOMEM;
 | 
						|
 | 
						|
	bzero(&sdmmc_dev, sizeof(sdmmc_dev));
 | 
						|
	error = sdio_register_driver(&bcmsdh_sdmmc_driver);
 | 
						|
 | 
						|
 | 
						|
	return error;
 | 
						|
}
 | 
						|
 | 
						|
/*
 | 
						|
 * module cleanup
 | 
						|
*/
 | 
						|
extern int bcmsdh_remove(struct device *dev);
 | 
						|
void sdio_function_cleanup(void)
 | 
						|
{
 | 
						|
	sd_trace(("%s Enter\n", __FUNCTION__));
 | 
						|
 | 
						|
 | 
						|
	sdio_unregister_driver(&bcmsdh_sdmmc_driver);
 | 
						|
 | 
						|
	if (gInstance)
 | 
						|
		kfree(gInstance);
 | 
						|
}
 |