525 lines
		
	
	
		
			13 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			525 lines
		
	
	
		
			13 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * linux/arch/arm/mach-omap2/mmc-twl4030.c
 | |
|  *
 | |
|  * Copyright (C) 2007-2008 Texas Instruments
 | |
|  * Copyright (C) 2008 Nokia Corporation
 | |
|  * Author: Texas Instruments
 | |
|  *
 | |
|  * This program is free software; you can redistribute it and/or modify
 | |
|  * it under the terms of the GNU General Public License version 2 as
 | |
|  * published by the Free Software Foundation.
 | |
|  */
 | |
| #include <linux/err.h>
 | |
| #include <linux/io.h>
 | |
| #include <linux/module.h>
 | |
| #include <linux/platform_device.h>
 | |
| #include <linux/interrupt.h>
 | |
| #include <linux/delay.h>
 | |
| #include <linux/gpio.h>
 | |
| #include <linux/mmc/host.h>
 | |
| #include <linux/regulator/consumer.h>
 | |
| 
 | |
| #include <mach/hardware.h>
 | |
| #include <mach/control.h>
 | |
| #include <mach/mmc.h>
 | |
| #include <mach/board.h>
 | |
| 
 | |
| #include "mmc-twl4030.h"
 | |
| 
 | |
| 
 | |
| #if defined(CONFIG_REGULATOR) && \
 | |
| 	(defined(CONFIG_MMC_OMAP_HS) || defined(CONFIG_MMC_OMAP_HS_MODULE))
 | |
| 
 | |
| static u16 control_pbias_offset;
 | |
| static u16 control_devconf1_offset;
 | |
| 
 | |
| #define HSMMC_NAME_LEN	9
 | |
| 
 | |
| static struct twl_mmc_controller {
 | |
| 	struct omap_mmc_platform_data	*mmc;
 | |
| 	/* Vcc == configured supply
 | |
| 	 * Vcc_alt == optional
 | |
| 	 *   -	MMC1, supply for DAT4..DAT7
 | |
| 	 *   -	MMC2/MMC2, external level shifter voltage supply, for
 | |
| 	 *	chip (SDIO, eMMC, etc) or transceiver (MMC2 only)
 | |
| 	 */
 | |
| 	struct regulator		*vcc;
 | |
| 	struct regulator		*vcc_aux;
 | |
| 	char				name[HSMMC_NAME_LEN + 1];
 | |
| } hsmmc[OMAP34XX_NR_MMC];
 | |
| 
 | |
| static int twl_mmc_card_detect(int irq)
 | |
| {
 | |
| 	unsigned i;
 | |
| 
 | |
| 	for (i = 0; i < ARRAY_SIZE(hsmmc); i++) {
 | |
| 		struct omap_mmc_platform_data *mmc;
 | |
| 
 | |
| 		mmc = hsmmc[i].mmc;
 | |
| 		if (!mmc)
 | |
| 			continue;
 | |
| 		if (irq != mmc->slots[0].card_detect_irq)
 | |
| 			continue;
 | |
| 
 | |
| 		/* NOTE: assumes card detect signal is active-low */
 | |
| 		return !gpio_get_value_cansleep(mmc->slots[0].switch_pin);
 | |
| 	}
 | |
| 	return -ENOSYS;
 | |
| }
 | |
| 
 | |
| static int twl_mmc_get_ro(struct device *dev, int slot)
 | |
| {
 | |
| 	struct omap_mmc_platform_data *mmc = dev->platform_data;
 | |
| 
 | |
| 	/* NOTE: assumes write protect signal is active-high */
 | |
| 	return gpio_get_value_cansleep(mmc->slots[0].gpio_wp);
 | |
| }
 | |
| 
 | |
| static int twl_mmc_get_cover_state(struct device *dev, int slot)
 | |
| {
 | |
| 	struct omap_mmc_platform_data *mmc = dev->platform_data;
 | |
| 
 | |
| 	/* NOTE: assumes card detect signal is active-low */
 | |
| 	return !gpio_get_value_cansleep(mmc->slots[0].switch_pin);
 | |
| }
 | |
| 
 | |
| /*
 | |
|  * MMC Slot Initialization.
 | |
|  */
 | |
| static int twl_mmc_late_init(struct device *dev)
 | |
| {
 | |
| 	struct omap_mmc_platform_data *mmc = dev->platform_data;
 | |
| 	int ret = 0;
 | |
| 	int i;
 | |
| 
 | |
| 	/* MMC/SD/SDIO doesn't require a card detect switch */
 | |
| 	if (gpio_is_valid(mmc->slots[0].switch_pin)) {
 | |
| 		ret = gpio_request(mmc->slots[0].switch_pin, "mmc_cd");
 | |
| 		if (ret)
 | |
| 			goto done;
 | |
| 		ret = gpio_direction_input(mmc->slots[0].switch_pin);
 | |
| 		if (ret)
 | |
| 			goto err;
 | |
| 	}
 | |
| 
 | |
| 	/* require at least main regulator */
 | |
| 	for (i = 0; i < ARRAY_SIZE(hsmmc); i++) {
 | |
| 		if (hsmmc[i].name == mmc->slots[0].name) {
 | |
| 			struct regulator *reg;
 | |
| 
 | |
| 			hsmmc[i].mmc = mmc;
 | |
| 
 | |
| 			reg = regulator_get(dev, "vmmc");
 | |
| 			if (IS_ERR(reg)) {
 | |
| 				dev_dbg(dev, "vmmc regulator missing\n");
 | |
| 				/* HACK: until fixed.c regulator is usable,
 | |
| 				 * we don't require a main regulator
 | |
| 				 * for MMC2 or MMC3
 | |
| 				 */
 | |
| 				if (i != 0)
 | |
| 					break;
 | |
| 				ret = PTR_ERR(reg);
 | |
| 				hsmmc[i].vcc = NULL;
 | |
| 				goto err;
 | |
| 			}
 | |
| 			hsmmc[i].vcc = reg;
 | |
| 			mmc->slots[0].ocr_mask = mmc_regulator_get_ocrmask(reg);
 | |
| 
 | |
| 			/* allow an aux regulator */
 | |
| 			reg = regulator_get(dev, "vmmc_aux");
 | |
| 			hsmmc[i].vcc_aux = IS_ERR(reg) ? NULL : reg;
 | |
| 
 | |
| 			/* UGLY HACK:  workaround regulator framework bugs.
 | |
| 			 * When the bootloader leaves a supply active, it's
 | |
| 			 * initialized with zero usecount ... and we can't
 | |
| 			 * disable it without first enabling it.  Until the
 | |
| 			 * framework is fixed, we need a workaround like this
 | |
| 			 * (which is safe for MMC, but not in general).
 | |
| 			 */
 | |
| 			if (regulator_is_enabled(hsmmc[i].vcc) > 0) {
 | |
| 				regulator_enable(hsmmc[i].vcc);
 | |
| 				regulator_disable(hsmmc[i].vcc);
 | |
| 			}
 | |
| 			if (hsmmc[i].vcc_aux) {
 | |
| 				if (regulator_is_enabled(reg) > 0) {
 | |
| 					regulator_enable(reg);
 | |
| 					regulator_disable(reg);
 | |
| 				}
 | |
| 			}
 | |
| 
 | |
| 			break;
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 	return 0;
 | |
| 
 | |
| err:
 | |
| 	gpio_free(mmc->slots[0].switch_pin);
 | |
| done:
 | |
| 	mmc->slots[0].card_detect_irq = 0;
 | |
| 	mmc->slots[0].card_detect = NULL;
 | |
| 
 | |
| 	dev_err(dev, "err %d configuring card detect\n", ret);
 | |
| 	return ret;
 | |
| }
 | |
| 
 | |
| static void twl_mmc_cleanup(struct device *dev)
 | |
| {
 | |
| 	struct omap_mmc_platform_data *mmc = dev->platform_data;
 | |
| 	int i;
 | |
| 
 | |
| 	gpio_free(mmc->slots[0].switch_pin);
 | |
| 	for(i = 0; i < ARRAY_SIZE(hsmmc); i++) {
 | |
| 		regulator_put(hsmmc[i].vcc);
 | |
| 		regulator_put(hsmmc[i].vcc_aux);
 | |
| 	}
 | |
| }
 | |
| 
 | |
| #ifdef CONFIG_PM
 | |
| 
 | |
| static int twl_mmc_suspend(struct device *dev, int slot)
 | |
| {
 | |
| 	struct omap_mmc_platform_data *mmc = dev->platform_data;
 | |
| 
 | |
| 	disable_irq(mmc->slots[0].card_detect_irq);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int twl_mmc_resume(struct device *dev, int slot)
 | |
| {
 | |
| 	struct omap_mmc_platform_data *mmc = dev->platform_data;
 | |
| 
 | |
| 	enable_irq(mmc->slots[0].card_detect_irq);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| #else
 | |
| #define twl_mmc_suspend	NULL
 | |
| #define twl_mmc_resume	NULL
 | |
| #endif
 | |
| 
 | |
| #if defined(CONFIG_ARCH_OMAP3) && defined(CONFIG_PM)
 | |
| 
 | |
| static int twl4030_mmc_get_context_loss(struct device *dev)
 | |
| {
 | |
| 	/* FIXME: PM DPS not implemented yet */
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| #else
 | |
| #define twl4030_mmc_get_context_loss NULL
 | |
| #endif
 | |
| 
 | |
| static int twl_mmc1_set_power(struct device *dev, int slot, int power_on,
 | |
| 				int vdd)
 | |
| {
 | |
| 	u32 reg;
 | |
| 	int ret = 0;
 | |
| 	struct twl_mmc_controller *c = &hsmmc[0];
 | |
| 	struct omap_mmc_platform_data *mmc = dev->platform_data;
 | |
| 
 | |
| 	/*
 | |
| 	 * Assume we power both OMAP VMMC1 (for CMD, CLK, DAT0..3) and the
 | |
| 	 * card with Vcc regulator (from twl4030 or whatever).  OMAP has both
 | |
| 	 * 1.8V and 3.0V modes, controlled by the PBIAS register.
 | |
| 	 *
 | |
| 	 * In 8-bit modes, OMAP VMMC1A (for DAT4..7) needs a supply, which
 | |
| 	 * is most naturally TWL VSIM; those pins also use PBIAS.
 | |
| 	 *
 | |
| 	 * FIXME handle VMMC1A as needed ...
 | |
| 	 */
 | |
| 	if (power_on) {
 | |
| 		if (cpu_is_omap2430()) {
 | |
| 			reg = omap_ctrl_readl(OMAP243X_CONTROL_DEVCONF1);
 | |
| 			if ((1 << vdd) >= MMC_VDD_30_31)
 | |
| 				reg |= OMAP243X_MMC1_ACTIVE_OVERWRITE;
 | |
| 			else
 | |
| 				reg &= ~OMAP243X_MMC1_ACTIVE_OVERWRITE;
 | |
| 			omap_ctrl_writel(reg, OMAP243X_CONTROL_DEVCONF1);
 | |
| 		}
 | |
| 
 | |
| 		if (mmc->slots[0].internal_clock) {
 | |
| 			reg = omap_ctrl_readl(OMAP2_CONTROL_DEVCONF0);
 | |
| 			reg |= OMAP2_MMCSDIO1ADPCLKISEL;
 | |
| 			omap_ctrl_writel(reg, OMAP2_CONTROL_DEVCONF0);
 | |
| 		}
 | |
| 
 | |
| 		reg = omap_ctrl_readl(control_pbias_offset);
 | |
| 		reg |= OMAP2_PBIASSPEEDCTRL0;
 | |
| 		reg &= ~OMAP2_PBIASLITEPWRDNZ0;
 | |
| 		omap_ctrl_writel(reg, control_pbias_offset);
 | |
| 
 | |
| 		ret = mmc_regulator_set_ocr(c->vcc, vdd);
 | |
| 
 | |
| 		/* 100ms delay required for PBIAS configuration */
 | |
| 		msleep(100);
 | |
| 		reg = omap_ctrl_readl(control_pbias_offset);
 | |
| 		reg |= (OMAP2_PBIASLITEPWRDNZ0 | OMAP2_PBIASSPEEDCTRL0);
 | |
| 		if ((1 << vdd) <= MMC_VDD_165_195)
 | |
| 			reg &= ~OMAP2_PBIASLITEVMODE0;
 | |
| 		else
 | |
| 			reg |= OMAP2_PBIASLITEVMODE0;
 | |
| 		omap_ctrl_writel(reg, control_pbias_offset);
 | |
| 	} else {
 | |
| 		reg = omap_ctrl_readl(control_pbias_offset);
 | |
| 		reg &= ~OMAP2_PBIASLITEPWRDNZ0;
 | |
| 		omap_ctrl_writel(reg, control_pbias_offset);
 | |
| 
 | |
| 		ret = mmc_regulator_set_ocr(c->vcc, 0);
 | |
| 
 | |
| 		/* 100ms delay required for PBIAS configuration */
 | |
| 		msleep(100);
 | |
| 		reg = omap_ctrl_readl(control_pbias_offset);
 | |
| 		reg |= (OMAP2_PBIASSPEEDCTRL0 | OMAP2_PBIASLITEPWRDNZ0 |
 | |
| 			OMAP2_PBIASLITEVMODE0);
 | |
| 		omap_ctrl_writel(reg, control_pbias_offset);
 | |
| 	}
 | |
| 
 | |
| 	return ret;
 | |
| }
 | |
| 
 | |
| static int twl_mmc23_set_power(struct device *dev, int slot, int power_on, int vdd)
 | |
| {
 | |
| 	int ret = 0;
 | |
| 	struct twl_mmc_controller *c = NULL;
 | |
| 	struct omap_mmc_platform_data *mmc = dev->platform_data;
 | |
| 	int i;
 | |
| 
 | |
| 	for (i = 1; i < ARRAY_SIZE(hsmmc); i++) {
 | |
| 		if (mmc == hsmmc[i].mmc) {
 | |
| 			c = &hsmmc[i];
 | |
| 			break;
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 	if (c == NULL)
 | |
| 		return -ENODEV;
 | |
| 
 | |
| 	/* If we don't see a Vcc regulator, assume it's a fixed
 | |
| 	 * voltage always-on regulator.
 | |
| 	 */
 | |
| 	if (!c->vcc)
 | |
| 		return 0;
 | |
| 
 | |
| 	/*
 | |
| 	 * Assume Vcc regulator is used only to power the card ... OMAP
 | |
| 	 * VDDS is used to power the pins, optionally with a transceiver to
 | |
| 	 * support cards using voltages other than VDDS (1.8V nominal).  When a
 | |
| 	 * transceiver is used, DAT3..7 are muxed as transceiver control pins.
 | |
| 	 *
 | |
| 	 * In some cases this regulator won't support enable/disable;
 | |
| 	 * e.g. it's a fixed rail for a WLAN chip.
 | |
| 	 *
 | |
| 	 * In other cases vcc_aux switches interface power.  Example, for
 | |
| 	 * eMMC cards it represents VccQ.  Sometimes transceivers or SDIO
 | |
| 	 * chips/cards need an interface voltage rail too.
 | |
| 	 */
 | |
| 	if (power_on) {
 | |
| 		/* only MMC2 supports a CLKIN */
 | |
| 		if (mmc->slots[0].internal_clock) {
 | |
| 			u32 reg;
 | |
| 
 | |
| 			reg = omap_ctrl_readl(control_devconf1_offset);
 | |
| 			reg |= OMAP2_MMCSDIO2ADPCLKISEL;
 | |
| 			omap_ctrl_writel(reg, control_devconf1_offset);
 | |
| 		}
 | |
| 		ret = mmc_regulator_set_ocr(c->vcc, vdd);
 | |
| 		/* enable interface voltage rail, if needed */
 | |
| 		if (ret == 0 && c->vcc_aux) {
 | |
| 			ret = regulator_enable(c->vcc_aux);
 | |
| 			if (ret < 0)
 | |
| 				ret = mmc_regulator_set_ocr(c->vcc, 0);
 | |
| 		}
 | |
| 	} else {
 | |
| 		if (c->vcc_aux && (ret = regulator_is_enabled(c->vcc_aux)) > 0)
 | |
| 			ret = regulator_disable(c->vcc_aux);
 | |
| 		if (ret == 0)
 | |
| 			ret = mmc_regulator_set_ocr(c->vcc, 0);
 | |
| 	}
 | |
| 
 | |
| 	return ret;
 | |
| }
 | |
| 
 | |
| static int twl_mmc1_set_sleep(struct device *dev, int slot, int sleep, int vdd,
 | |
| 			      int cardsleep)
 | |
| {
 | |
| 	struct twl_mmc_controller *c = &hsmmc[0];
 | |
| 	int mode = sleep ? REGULATOR_MODE_STANDBY : REGULATOR_MODE_NORMAL;
 | |
| 
 | |
| 	return regulator_set_mode(c->vcc, mode);
 | |
| }
 | |
| 
 | |
| static int twl_mmc23_set_sleep(struct device *dev, int slot, int sleep, int vdd,
 | |
| 			       int cardsleep)
 | |
| {
 | |
| 	struct twl_mmc_controller *c = NULL;
 | |
| 	struct omap_mmc_platform_data *mmc = dev->platform_data;
 | |
| 	int i, err, mode;
 | |
| 
 | |
| 	for (i = 1; i < ARRAY_SIZE(hsmmc); i++) {
 | |
| 		if (mmc == hsmmc[i].mmc) {
 | |
| 			c = &hsmmc[i];
 | |
| 			break;
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 	if (c == NULL)
 | |
| 		return -ENODEV;
 | |
| 
 | |
| 	/*
 | |
| 	 * If we don't see a Vcc regulator, assume it's a fixed
 | |
| 	 * voltage always-on regulator.
 | |
| 	 */
 | |
| 	if (!c->vcc)
 | |
| 		return 0;
 | |
| 
 | |
| 	mode = sleep ? REGULATOR_MODE_STANDBY : REGULATOR_MODE_NORMAL;
 | |
| 
 | |
| 	if (!c->vcc_aux)
 | |
| 		return regulator_set_mode(c->vcc, mode);
 | |
| 
 | |
| 	if (cardsleep) {
 | |
| 		/* VCC can be turned off if card is asleep */
 | |
| 		struct regulator *vcc_aux = c->vcc_aux;
 | |
| 
 | |
| 		c->vcc_aux = NULL;
 | |
| 		if (sleep)
 | |
| 			err = twl_mmc23_set_power(dev, slot, 0, 0);
 | |
| 		else
 | |
| 			err = twl_mmc23_set_power(dev, slot, 1, vdd);
 | |
| 		c->vcc_aux = vcc_aux;
 | |
| 	} else
 | |
| 		err = regulator_set_mode(c->vcc, mode);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 	return regulator_set_mode(c->vcc_aux, mode);
 | |
| }
 | |
| 
 | |
| static struct omap_mmc_platform_data *hsmmc_data[OMAP34XX_NR_MMC] __initdata;
 | |
| 
 | |
| void __init twl4030_mmc_init(struct twl4030_hsmmc_info *controllers)
 | |
| {
 | |
| 	struct twl4030_hsmmc_info *c;
 | |
| 	int nr_hsmmc = ARRAY_SIZE(hsmmc_data);
 | |
| 
 | |
| 	if (cpu_is_omap2430()) {
 | |
| 		control_pbias_offset = OMAP243X_CONTROL_PBIAS_LITE;
 | |
| 		control_devconf1_offset = OMAP243X_CONTROL_DEVCONF1;
 | |
| 		nr_hsmmc = 2;
 | |
| 	} else {
 | |
| 		control_pbias_offset = OMAP343X_CONTROL_PBIAS_LITE;
 | |
| 		control_devconf1_offset = OMAP343X_CONTROL_DEVCONF1;
 | |
| 	}
 | |
| 
 | |
| 	for (c = controllers; c->mmc; c++) {
 | |
| 		struct twl_mmc_controller *twl = hsmmc + c->mmc - 1;
 | |
| 		struct omap_mmc_platform_data *mmc = hsmmc_data[c->mmc - 1];
 | |
| 
 | |
| 		if (!c->mmc || c->mmc > nr_hsmmc) {
 | |
| 			pr_debug("MMC%d: no such controller\n", c->mmc);
 | |
| 			continue;
 | |
| 		}
 | |
| 		if (mmc) {
 | |
| 			pr_debug("MMC%d: already configured\n", c->mmc);
 | |
| 			continue;
 | |
| 		}
 | |
| 
 | |
| 		mmc = kzalloc(sizeof(struct omap_mmc_platform_data), GFP_KERNEL);
 | |
| 		if (!mmc) {
 | |
| 			pr_err("Cannot allocate memory for mmc device!\n");
 | |
| 			return;
 | |
| 		}
 | |
| 
 | |
| 		if (c->name)
 | |
| 			strncpy(twl->name, c->name, HSMMC_NAME_LEN);
 | |
| 		else
 | |
| 			snprintf(twl->name, ARRAY_SIZE(twl->name),
 | |
| 				"mmc%islot%i", c->mmc, 1);
 | |
| 		mmc->slots[0].name = twl->name;
 | |
| 		mmc->nr_slots = 1;
 | |
| 		mmc->slots[0].wires = c->wires;
 | |
| 		mmc->slots[0].internal_clock = !c->ext_clock;
 | |
| 		mmc->dma_mask = 0xffffffff;
 | |
| 		mmc->init = twl_mmc_late_init;
 | |
| 
 | |
| 		/* note: twl4030 card detect GPIOs can disable VMMCx ... */
 | |
| 		if (gpio_is_valid(c->gpio_cd)) {
 | |
| 			mmc->cleanup = twl_mmc_cleanup;
 | |
| 			mmc->suspend = twl_mmc_suspend;
 | |
| 			mmc->resume = twl_mmc_resume;
 | |
| 
 | |
| 			mmc->slots[0].switch_pin = c->gpio_cd;
 | |
| 			mmc->slots[0].card_detect_irq = gpio_to_irq(c->gpio_cd);
 | |
| 			if (c->cover_only)
 | |
| 				mmc->slots[0].get_cover_state = twl_mmc_get_cover_state;
 | |
| 			else
 | |
| 				mmc->slots[0].card_detect = twl_mmc_card_detect;
 | |
| 		} else
 | |
| 			mmc->slots[0].switch_pin = -EINVAL;
 | |
| 
 | |
| 		mmc->get_context_loss_count =
 | |
| 				twl4030_mmc_get_context_loss;
 | |
| 
 | |
| 		/* write protect normally uses an OMAP gpio */
 | |
| 		if (gpio_is_valid(c->gpio_wp)) {
 | |
| 			gpio_request(c->gpio_wp, "mmc_wp");
 | |
| 			gpio_direction_input(c->gpio_wp);
 | |
| 
 | |
| 			mmc->slots[0].gpio_wp = c->gpio_wp;
 | |
| 			mmc->slots[0].get_ro = twl_mmc_get_ro;
 | |
| 		} else
 | |
| 			mmc->slots[0].gpio_wp = -EINVAL;
 | |
| 
 | |
| 		if (c->nonremovable)
 | |
| 			mmc->slots[0].nonremovable = 1;
 | |
| 
 | |
| 		if (c->power_saving)
 | |
| 			mmc->slots[0].power_saving = 1;
 | |
| 
 | |
| 		/* NOTE:  MMC slots should have a Vcc regulator set up.
 | |
| 		 * This may be from a TWL4030-family chip, another
 | |
| 		 * controllable regulator, or a fixed supply.
 | |
| 		 *
 | |
| 		 * temporary HACK: ocr_mask instead of fixed supply
 | |
| 		 */
 | |
| 		mmc->slots[0].ocr_mask = c->ocr_mask;
 | |
| 
 | |
| 		switch (c->mmc) {
 | |
| 		case 1:
 | |
| 			/* on-chip level shifting via PBIAS0/PBIAS1 */
 | |
| 			mmc->slots[0].set_power = twl_mmc1_set_power;
 | |
| 			mmc->slots[0].set_sleep = twl_mmc1_set_sleep;
 | |
| 			break;
 | |
| 		case 2:
 | |
| 			if (c->ext_clock)
 | |
| 				c->transceiver = 1;
 | |
| 			if (c->transceiver && c->wires > 4)
 | |
| 				c->wires = 4;
 | |
| 			/* FALLTHROUGH */
 | |
| 		case 3:
 | |
| 			/* off-chip level shifting, or none */
 | |
| 			mmc->slots[0].set_power = twl_mmc23_set_power;
 | |
| 			mmc->slots[0].set_sleep = twl_mmc23_set_sleep;
 | |
| 			break;
 | |
| 		default:
 | |
| 			pr_err("MMC%d configuration not supported!\n", c->mmc);
 | |
| 			kfree(mmc);
 | |
| 			continue;
 | |
| 		}
 | |
| 		hsmmc_data[c->mmc - 1] = mmc;
 | |
| 	}
 | |
| 
 | |
| 	omap2_init_mmc(hsmmc_data, OMAP34XX_NR_MMC);
 | |
| 
 | |
| 	/* pass the device nodes back to board setup code */
 | |
| 	for (c = controllers; c->mmc; c++) {
 | |
| 		struct omap_mmc_platform_data *mmc = hsmmc_data[c->mmc - 1];
 | |
| 
 | |
| 		if (!c->mmc || c->mmc > nr_hsmmc)
 | |
| 			continue;
 | |
| 		c->dev = mmc->dev;
 | |
| 	}
 | |
| }
 | |
| 
 | |
| #endif
 |