| /* | 
 |  * linux/arch/arm/mach-omap2/hsmmc.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/kernel.h> | 
 | #include <linux/slab.h> | 
 | #include <linux/string.h> | 
 | #include <linux/delay.h> | 
 | #include <linux/gpio.h> | 
 | #include <linux/platform_data/gpio-omap.h> | 
 |  | 
 | #include "soc.h" | 
 | #include "omap_device.h" | 
 | #include "omap-pm.h" | 
 |  | 
 | #include "mux.h" | 
 | #include "mmc.h" | 
 | #include "hsmmc.h" | 
 | #include "control.h" | 
 |  | 
 | #if defined(CONFIG_MMC_OMAP_HS) || defined(CONFIG_MMC_OMAP_HS_MODULE) | 
 |  | 
 | static u16 control_pbias_offset; | 
 | static u16 control_devconf1_offset; | 
 | static u16 control_mmc1; | 
 |  | 
 | #define HSMMC_NAME_LEN	9 | 
 |  | 
 | #if defined(CONFIG_ARCH_OMAP3) && defined(CONFIG_PM) | 
 |  | 
 | static int hsmmc_get_context_loss(struct device *dev) | 
 | { | 
 | 	return omap_pm_get_dev_context_loss_count(dev); | 
 | } | 
 |  | 
 | #else | 
 | #define hsmmc_get_context_loss NULL | 
 | #endif | 
 |  | 
 | static void omap_hsmmc1_before_set_reg(struct device *dev, int slot, | 
 | 				  int power_on, int vdd) | 
 | { | 
 | 	u32 reg, prog_io; | 
 | 	struct omap_mmc_platform_data *mmc = dev->platform_data; | 
 |  | 
 | 	if (mmc->slots[0].remux) | 
 | 		mmc->slots[0].remux(dev, slot, power_on); | 
 |  | 
 | 	/* | 
 | 	 * 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); | 
 | 		if (cpu_is_omap3630()) { | 
 | 			/* Set MMC I/O to 52Mhz */ | 
 | 			prog_io = omap_ctrl_readl(OMAP343X_CONTROL_PROG_IO1); | 
 | 			prog_io |= OMAP3630_PRG_SDMMC1_SPEEDCTRL; | 
 | 			omap_ctrl_writel(prog_io, OMAP343X_CONTROL_PROG_IO1); | 
 | 		} else { | 
 | 			reg |= OMAP2_PBIASSPEEDCTRL0; | 
 | 		} | 
 | 		reg &= ~OMAP2_PBIASLITEPWRDNZ0; | 
 | 		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); | 
 | 	} | 
 | } | 
 |  | 
 | static void omap_hsmmc1_after_set_reg(struct device *dev, int slot, | 
 | 				 int power_on, int vdd) | 
 | { | 
 | 	u32 reg; | 
 |  | 
 | 	/* 100ms delay required for PBIAS configuration */ | 
 | 	msleep(100); | 
 |  | 
 | 	if (power_on) { | 
 | 		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_PBIASSPEEDCTRL0 | OMAP2_PBIASLITEPWRDNZ0 | | 
 | 			OMAP2_PBIASLITEVMODE0); | 
 | 		omap_ctrl_writel(reg, control_pbias_offset); | 
 | 	} | 
 | } | 
 |  | 
 | static void omap4_hsmmc1_before_set_reg(struct device *dev, int slot, | 
 | 				  int power_on, int vdd) | 
 | { | 
 | 	u32 reg; | 
 |  | 
 | 	/* | 
 | 	 * 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. | 
 | 	 */ | 
 | 	reg = omap4_ctrl_pad_readl(control_pbias_offset); | 
 | 	reg &= ~(OMAP4_MMC1_PBIASLITE_PWRDNZ_MASK | | 
 | 		OMAP4_MMC1_PWRDNZ_MASK | | 
 | 		OMAP4_MMC1_PBIASLITE_VMODE_MASK); | 
 | 	omap4_ctrl_pad_writel(reg, control_pbias_offset); | 
 | } | 
 |  | 
 | static void omap4_hsmmc1_after_set_reg(struct device *dev, int slot, | 
 | 				 int power_on, int vdd) | 
 | { | 
 | 	u32 reg; | 
 | 	unsigned long timeout; | 
 |  | 
 | 	if (power_on) { | 
 | 		reg = omap4_ctrl_pad_readl(control_pbias_offset); | 
 | 		reg |= OMAP4_MMC1_PBIASLITE_PWRDNZ_MASK; | 
 | 		if ((1 << vdd) <= MMC_VDD_165_195) | 
 | 			reg &= ~OMAP4_MMC1_PBIASLITE_VMODE_MASK; | 
 | 		else | 
 | 			reg |= OMAP4_MMC1_PBIASLITE_VMODE_MASK; | 
 | 		reg |= (OMAP4_MMC1_PBIASLITE_PWRDNZ_MASK | | 
 | 			OMAP4_MMC1_PWRDNZ_MASK); | 
 | 		omap4_ctrl_pad_writel(reg, control_pbias_offset); | 
 |  | 
 | 		timeout = jiffies + msecs_to_jiffies(5); | 
 | 		do { | 
 | 			reg = omap4_ctrl_pad_readl(control_pbias_offset); | 
 | 			if (!(reg & OMAP4_MMC1_PBIASLITE_VMODE_ERROR_MASK)) | 
 | 				break; | 
 | 			usleep_range(100, 200); | 
 | 		} while (!time_after(jiffies, timeout)); | 
 |  | 
 | 		if (reg & OMAP4_MMC1_PBIASLITE_VMODE_ERROR_MASK) { | 
 | 			pr_err("Pbias Voltage is not same as LDO\n"); | 
 | 			/* Caution : On VMODE_ERROR Power Down MMC IO */ | 
 | 			reg &= ~(OMAP4_MMC1_PWRDNZ_MASK); | 
 | 			omap4_ctrl_pad_writel(reg, control_pbias_offset); | 
 | 		} | 
 | 	} | 
 | } | 
 |  | 
 | static void hsmmc2_select_input_clk_src(struct omap_mmc_platform_data *mmc) | 
 | { | 
 | 	u32 reg; | 
 |  | 
 | 	reg = omap_ctrl_readl(control_devconf1_offset); | 
 | 	if (mmc->slots[0].internal_clock) | 
 | 		reg |= OMAP2_MMCSDIO2ADPCLKISEL; | 
 | 	else | 
 | 		reg &= ~OMAP2_MMCSDIO2ADPCLKISEL; | 
 | 	omap_ctrl_writel(reg, control_devconf1_offset); | 
 | } | 
 |  | 
 | static void hsmmc2_before_set_reg(struct device *dev, int slot, | 
 | 				   int power_on, int vdd) | 
 | { | 
 | 	struct omap_mmc_platform_data *mmc = dev->platform_data; | 
 |  | 
 | 	if (mmc->slots[0].remux) | 
 | 		mmc->slots[0].remux(dev, slot, power_on); | 
 |  | 
 | 	if (power_on) | 
 | 		hsmmc2_select_input_clk_src(mmc); | 
 | } | 
 |  | 
 | static int am35x_hsmmc2_set_power(struct device *dev, int slot, | 
 | 				  int power_on, int vdd) | 
 | { | 
 | 	struct omap_mmc_platform_data *mmc = dev->platform_data; | 
 |  | 
 | 	if (power_on) | 
 | 		hsmmc2_select_input_clk_src(mmc); | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | static int nop_mmc_set_power(struct device *dev, int slot, int power_on, | 
 | 							int vdd) | 
 | { | 
 | 	return 0; | 
 | } | 
 |  | 
 | static inline void omap_hsmmc_mux(struct omap_mmc_platform_data *mmc_controller, | 
 | 			int controller_nr) | 
 | { | 
 | 	if (gpio_is_valid(mmc_controller->slots[0].switch_pin) && | 
 | 		(mmc_controller->slots[0].switch_pin < OMAP_MAX_GPIO_LINES)) | 
 | 		omap_mux_init_gpio(mmc_controller->slots[0].switch_pin, | 
 | 					OMAP_PIN_INPUT_PULLUP); | 
 | 	if (gpio_is_valid(mmc_controller->slots[0].gpio_wp) && | 
 | 		(mmc_controller->slots[0].gpio_wp < OMAP_MAX_GPIO_LINES)) | 
 | 		omap_mux_init_gpio(mmc_controller->slots[0].gpio_wp, | 
 | 					OMAP_PIN_INPUT_PULLUP); | 
 | 	if (cpu_is_omap34xx()) { | 
 | 		if (controller_nr == 0) { | 
 | 			omap_mux_init_signal("sdmmc1_clk", | 
 | 				OMAP_PIN_INPUT_PULLUP); | 
 | 			omap_mux_init_signal("sdmmc1_cmd", | 
 | 				OMAP_PIN_INPUT_PULLUP); | 
 | 			omap_mux_init_signal("sdmmc1_dat0", | 
 | 				OMAP_PIN_INPUT_PULLUP); | 
 | 			if (mmc_controller->slots[0].caps & | 
 | 				(MMC_CAP_4_BIT_DATA | MMC_CAP_8_BIT_DATA)) { | 
 | 				omap_mux_init_signal("sdmmc1_dat1", | 
 | 					OMAP_PIN_INPUT_PULLUP); | 
 | 				omap_mux_init_signal("sdmmc1_dat2", | 
 | 					OMAP_PIN_INPUT_PULLUP); | 
 | 				omap_mux_init_signal("sdmmc1_dat3", | 
 | 					OMAP_PIN_INPUT_PULLUP); | 
 | 			} | 
 | 			if (mmc_controller->slots[0].caps & | 
 | 						MMC_CAP_8_BIT_DATA) { | 
 | 				omap_mux_init_signal("sdmmc1_dat4", | 
 | 					OMAP_PIN_INPUT_PULLUP); | 
 | 				omap_mux_init_signal("sdmmc1_dat5", | 
 | 					OMAP_PIN_INPUT_PULLUP); | 
 | 				omap_mux_init_signal("sdmmc1_dat6", | 
 | 					OMAP_PIN_INPUT_PULLUP); | 
 | 				omap_mux_init_signal("sdmmc1_dat7", | 
 | 					OMAP_PIN_INPUT_PULLUP); | 
 | 			} | 
 | 		} | 
 | 		if (controller_nr == 1) { | 
 | 			/* MMC2 */ | 
 | 			omap_mux_init_signal("sdmmc2_clk", | 
 | 				OMAP_PIN_INPUT_PULLUP); | 
 | 			omap_mux_init_signal("sdmmc2_cmd", | 
 | 				OMAP_PIN_INPUT_PULLUP); | 
 | 			omap_mux_init_signal("sdmmc2_dat0", | 
 | 				OMAP_PIN_INPUT_PULLUP); | 
 |  | 
 | 			/* | 
 | 			 * For 8 wire configurations, Lines DAT4, 5, 6 and 7 | 
 | 			 * need to be muxed in the board-*.c files | 
 | 			 */ | 
 | 			if (mmc_controller->slots[0].caps & | 
 | 				(MMC_CAP_4_BIT_DATA | MMC_CAP_8_BIT_DATA)) { | 
 | 				omap_mux_init_signal("sdmmc2_dat1", | 
 | 					OMAP_PIN_INPUT_PULLUP); | 
 | 				omap_mux_init_signal("sdmmc2_dat2", | 
 | 					OMAP_PIN_INPUT_PULLUP); | 
 | 				omap_mux_init_signal("sdmmc2_dat3", | 
 | 					OMAP_PIN_INPUT_PULLUP); | 
 | 			} | 
 | 			if (mmc_controller->slots[0].caps & | 
 | 							MMC_CAP_8_BIT_DATA) { | 
 | 				omap_mux_init_signal("sdmmc2_dat4.sdmmc2_dat4", | 
 | 					OMAP_PIN_INPUT_PULLUP); | 
 | 				omap_mux_init_signal("sdmmc2_dat5.sdmmc2_dat5", | 
 | 					OMAP_PIN_INPUT_PULLUP); | 
 | 				omap_mux_init_signal("sdmmc2_dat6.sdmmc2_dat6", | 
 | 					OMAP_PIN_INPUT_PULLUP); | 
 | 				omap_mux_init_signal("sdmmc2_dat7.sdmmc2_dat7", | 
 | 					OMAP_PIN_INPUT_PULLUP); | 
 | 			} | 
 | 		} | 
 |  | 
 | 		/* | 
 | 		 * For MMC3 the pins need to be muxed in the board-*.c files | 
 | 		 */ | 
 | 	} | 
 | } | 
 |  | 
 | static int __init omap_hsmmc_pdata_init(struct omap2_hsmmc_info *c, | 
 | 					struct omap_mmc_platform_data *mmc) | 
 | { | 
 | 	char *hc_name; | 
 |  | 
 | 	hc_name = kzalloc(sizeof(char) * (HSMMC_NAME_LEN + 1), GFP_KERNEL); | 
 | 	if (!hc_name) { | 
 | 		pr_err("Cannot allocate memory for controller slot name\n"); | 
 | 		kfree(hc_name); | 
 | 		return -ENOMEM; | 
 | 	} | 
 |  | 
 | 	if (c->name) | 
 | 		strncpy(hc_name, c->name, HSMMC_NAME_LEN); | 
 | 	else | 
 | 		snprintf(hc_name, (HSMMC_NAME_LEN + 1), "mmc%islot%i", | 
 | 								c->mmc, 1); | 
 | 	mmc->slots[0].name = hc_name; | 
 | 	mmc->nr_slots = 1; | 
 | 	mmc->slots[0].caps = c->caps; | 
 | 	mmc->slots[0].pm_caps = c->pm_caps; | 
 | 	mmc->slots[0].internal_clock = !c->ext_clock; | 
 | 	mmc->max_freq = c->max_freq; | 
 | 	if (cpu_is_omap44xx()) | 
 | 		mmc->reg_offset = OMAP4_MMC_REG_OFFSET; | 
 | 	else | 
 | 		mmc->reg_offset = 0; | 
 |  | 
 | 	mmc->get_context_loss_count = hsmmc_get_context_loss; | 
 |  | 
 | 	mmc->slots[0].switch_pin = c->gpio_cd; | 
 | 	mmc->slots[0].gpio_wp = c->gpio_wp; | 
 |  | 
 | 	mmc->slots[0].remux = c->remux; | 
 | 	mmc->slots[0].init_card = c->init_card; | 
 |  | 
 | 	if (c->cover_only) | 
 | 		mmc->slots[0].cover = 1; | 
 |  | 
 | 	if (c->nonremovable) | 
 | 		mmc->slots[0].nonremovable = 1; | 
 |  | 
 | 	if (c->power_saving) | 
 | 		mmc->slots[0].power_saving = 1; | 
 |  | 
 | 	if (c->no_off) | 
 | 		mmc->slots[0].no_off = 1; | 
 |  | 
 | 	if (c->no_off_init) | 
 | 		mmc->slots[0].no_regulator_off_init = c->no_off_init; | 
 |  | 
 | 	if (c->vcc_aux_disable_is_sleep) | 
 | 		mmc->slots[0].vcc_aux_disable_is_sleep = 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 | 
 | 	 */ | 
 | 	if (soc_is_am35xx()) | 
 | 		mmc->slots[0].ocr_mask = MMC_VDD_165_195 | | 
 | 					 MMC_VDD_26_27 | | 
 | 					 MMC_VDD_27_28 | | 
 | 					 MMC_VDD_29_30 | | 
 | 					 MMC_VDD_30_31 | | 
 | 					 MMC_VDD_31_32; | 
 | 	else | 
 | 		mmc->slots[0].ocr_mask = c->ocr_mask; | 
 |  | 
 | 	if (!soc_is_am35xx()) | 
 | 		mmc->slots[0].features |= HSMMC_HAS_PBIAS; | 
 |  | 
 | 	if (cpu_is_omap44xx() && (omap_rev() > OMAP4430_REV_ES1_0)) | 
 | 		mmc->slots[0].features |= HSMMC_HAS_UPDATED_RESET; | 
 |  | 
 | 	switch (c->mmc) { | 
 | 	case 1: | 
 | 		if (mmc->slots[0].features & HSMMC_HAS_PBIAS) { | 
 | 			/* on-chip level shifting via PBIAS0/PBIAS1 */ | 
 | 			if (cpu_is_omap44xx()) { | 
 | 				mmc->slots[0].before_set_reg = | 
 | 						omap4_hsmmc1_before_set_reg; | 
 | 				mmc->slots[0].after_set_reg = | 
 | 						omap4_hsmmc1_after_set_reg; | 
 | 			} else { | 
 | 				mmc->slots[0].before_set_reg = | 
 | 						omap_hsmmc1_before_set_reg; | 
 | 				mmc->slots[0].after_set_reg = | 
 | 						omap_hsmmc1_after_set_reg; | 
 | 			} | 
 | 		} | 
 |  | 
 | 		if (soc_is_am35xx()) | 
 | 			mmc->slots[0].set_power = nop_mmc_set_power; | 
 |  | 
 | 		/* OMAP3630 HSMMC1 supports only 4-bit */ | 
 | 		if (cpu_is_omap3630() && | 
 | 				(c->caps & MMC_CAP_8_BIT_DATA)) { | 
 | 			c->caps &= ~MMC_CAP_8_BIT_DATA; | 
 | 			c->caps |= MMC_CAP_4_BIT_DATA; | 
 | 			mmc->slots[0].caps = c->caps; | 
 | 		} | 
 | 		break; | 
 | 	case 2: | 
 | 		if (soc_is_am35xx()) | 
 | 			mmc->slots[0].set_power = am35x_hsmmc2_set_power; | 
 |  | 
 | 		if (c->ext_clock) | 
 | 			c->transceiver = 1; | 
 | 		if (c->transceiver && (c->caps & MMC_CAP_8_BIT_DATA)) { | 
 | 			c->caps &= ~MMC_CAP_8_BIT_DATA; | 
 | 			c->caps |= MMC_CAP_4_BIT_DATA; | 
 | 		} | 
 | 		if (mmc->slots[0].features & HSMMC_HAS_PBIAS) { | 
 | 			/* off-chip level shifting, or none */ | 
 | 			mmc->slots[0].before_set_reg = hsmmc2_before_set_reg; | 
 | 			mmc->slots[0].after_set_reg = NULL; | 
 | 		} | 
 | 		break; | 
 | 	case 3: | 
 | 	case 4: | 
 | 	case 5: | 
 | 		mmc->slots[0].before_set_reg = NULL; | 
 | 		mmc->slots[0].after_set_reg = NULL; | 
 | 		break; | 
 | 	default: | 
 | 		pr_err("MMC%d configuration not supported!\n", c->mmc); | 
 | 		kfree(hc_name); | 
 | 		return -ENODEV; | 
 | 	} | 
 | 	return 0; | 
 | } | 
 |  | 
 | static int omap_hsmmc_done; | 
 |  | 
 | void omap_hsmmc_late_init(struct omap2_hsmmc_info *c) | 
 | { | 
 | 	struct platform_device *pdev; | 
 | 	struct omap_mmc_platform_data *mmc_pdata; | 
 | 	int res; | 
 |  | 
 | 	if (omap_hsmmc_done != 1) | 
 | 		return; | 
 |  | 
 | 	omap_hsmmc_done++; | 
 |  | 
 | 	for (; c->mmc; c++) { | 
 | 		if (!c->deferred) | 
 | 			continue; | 
 |  | 
 | 		pdev = c->pdev; | 
 | 		if (!pdev) | 
 | 			continue; | 
 |  | 
 | 		mmc_pdata = pdev->dev.platform_data; | 
 | 		if (!mmc_pdata) | 
 | 			continue; | 
 |  | 
 | 		mmc_pdata->slots[0].switch_pin = c->gpio_cd; | 
 | 		mmc_pdata->slots[0].gpio_wp = c->gpio_wp; | 
 |  | 
 | 		res = omap_device_register(pdev); | 
 | 		if (res) | 
 | 			pr_err("Could not late init MMC %s\n", | 
 | 			       c->name); | 
 | 	} | 
 | } | 
 |  | 
 | #define MAX_OMAP_MMC_HWMOD_NAME_LEN		16 | 
 |  | 
 | static void __init omap_hsmmc_init_one(struct omap2_hsmmc_info *hsmmcinfo, | 
 | 					int ctrl_nr) | 
 | { | 
 | 	struct omap_hwmod *oh; | 
 | 	struct omap_hwmod *ohs[1]; | 
 | 	struct omap_device *od; | 
 | 	struct platform_device *pdev; | 
 | 	char oh_name[MAX_OMAP_MMC_HWMOD_NAME_LEN]; | 
 | 	struct omap_mmc_platform_data *mmc_data; | 
 | 	struct omap_mmc_dev_attr *mmc_dev_attr; | 
 | 	char *name; | 
 | 	int res; | 
 |  | 
 | 	mmc_data = kzalloc(sizeof(struct omap_mmc_platform_data), GFP_KERNEL); | 
 | 	if (!mmc_data) { | 
 | 		pr_err("Cannot allocate memory for mmc device!\n"); | 
 | 		return; | 
 | 	} | 
 |  | 
 | 	res = omap_hsmmc_pdata_init(hsmmcinfo, mmc_data); | 
 | 	if (res < 0) | 
 | 		goto free_mmc; | 
 |  | 
 | 	omap_hsmmc_mux(mmc_data, (ctrl_nr - 1)); | 
 |  | 
 | 	name = "omap_hsmmc"; | 
 | 	res = snprintf(oh_name, MAX_OMAP_MMC_HWMOD_NAME_LEN, | 
 | 		     "mmc%d", ctrl_nr); | 
 | 	WARN(res >= MAX_OMAP_MMC_HWMOD_NAME_LEN, | 
 | 	     "String buffer overflow in MMC%d device setup\n", ctrl_nr); | 
 |  | 
 | 	oh = omap_hwmod_lookup(oh_name); | 
 | 	if (!oh) { | 
 | 		pr_err("Could not look up %s\n", oh_name); | 
 | 		goto free_name; | 
 | 	} | 
 | 	ohs[0] = oh; | 
 | 	if (oh->dev_attr != NULL) { | 
 | 		mmc_dev_attr = oh->dev_attr; | 
 | 		mmc_data->controller_flags = mmc_dev_attr->flags; | 
 | 		/* | 
 | 		 * erratum 2.1.1.128 doesn't apply if board has | 
 | 		 * a transceiver is attached | 
 | 		 */ | 
 | 		if (hsmmcinfo->transceiver) | 
 | 			mmc_data->controller_flags &= | 
 | 				~OMAP_HSMMC_BROKEN_MULTIBLOCK_READ; | 
 | 	} | 
 |  | 
 | 	pdev = platform_device_alloc(name, ctrl_nr - 1); | 
 | 	if (!pdev) { | 
 | 		pr_err("Could not allocate pdev for %s\n", name); | 
 | 		goto free_name; | 
 | 	} | 
 | 	dev_set_name(&pdev->dev, "%s.%d", pdev->name, pdev->id); | 
 |  | 
 | 	od = omap_device_alloc(pdev, ohs, 1); | 
 | 	if (IS_ERR(od)) { | 
 | 		pr_err("Could not allocate od for %s\n", name); | 
 | 		goto put_pdev; | 
 | 	} | 
 |  | 
 | 	res = platform_device_add_data(pdev, mmc_data, | 
 | 			      sizeof(struct omap_mmc_platform_data)); | 
 | 	if (res) { | 
 | 		pr_err("Could not add pdata for %s\n", name); | 
 | 		goto put_pdev; | 
 | 	} | 
 |  | 
 | 	hsmmcinfo->pdev = pdev; | 
 |  | 
 | 	if (hsmmcinfo->deferred) | 
 | 		goto free_mmc; | 
 |  | 
 | 	res = omap_device_register(pdev); | 
 | 	if (res) { | 
 | 		pr_err("Could not register od for %s\n", name); | 
 | 		goto free_od; | 
 | 	} | 
 |  | 
 | 	goto free_mmc; | 
 |  | 
 | free_od: | 
 | 	omap_device_delete(od); | 
 |  | 
 | put_pdev: | 
 | 	platform_device_put(pdev); | 
 |  | 
 | free_name: | 
 | 	kfree(mmc_data->slots[0].name); | 
 |  | 
 | free_mmc: | 
 | 	kfree(mmc_data); | 
 | } | 
 |  | 
 | void __init omap_hsmmc_init(struct omap2_hsmmc_info *controllers) | 
 | { | 
 | 	u32 reg; | 
 |  | 
 | 	if (omap_hsmmc_done) | 
 | 		return; | 
 |  | 
 | 	omap_hsmmc_done = 1; | 
 |  | 
 | 	if (!cpu_is_omap44xx()) { | 
 | 		if (cpu_is_omap2430()) { | 
 | 			control_pbias_offset = OMAP243X_CONTROL_PBIAS_LITE; | 
 | 			control_devconf1_offset = OMAP243X_CONTROL_DEVCONF1; | 
 | 		} else { | 
 | 			control_pbias_offset = OMAP343X_CONTROL_PBIAS_LITE; | 
 | 			control_devconf1_offset = OMAP343X_CONTROL_DEVCONF1; | 
 | 		} | 
 | 	} else { | 
 | 		control_pbias_offset = | 
 | 			OMAP4_CTRL_MODULE_PAD_CORE_CONTROL_PBIASLITE; | 
 | 		control_mmc1 = OMAP4_CTRL_MODULE_PAD_CORE_CONTROL_MMC1; | 
 | 		reg = omap4_ctrl_pad_readl(control_mmc1); | 
 | 		reg |= (OMAP4_SDMMC1_PUSTRENGTH_GRP0_MASK | | 
 | 			OMAP4_SDMMC1_PUSTRENGTH_GRP1_MASK); | 
 | 		reg &= ~(OMAP4_SDMMC1_PUSTRENGTH_GRP2_MASK | | 
 | 			OMAP4_SDMMC1_PUSTRENGTH_GRP3_MASK); | 
 | 		reg |= (OMAP4_SDMMC1_DR0_SPEEDCTRL_MASK | | 
 | 			OMAP4_SDMMC1_DR1_SPEEDCTRL_MASK | | 
 | 			OMAP4_SDMMC1_DR2_SPEEDCTRL_MASK); | 
 | 		omap4_ctrl_pad_writel(reg, control_mmc1); | 
 | 	} | 
 |  | 
 | 	for (; controllers->mmc; controllers++) | 
 | 		omap_hsmmc_init_one(controllers, controllers->mmc); | 
 |  | 
 | } | 
 |  | 
 | #endif |