2008-12-11 01:37:17 +00:00
|
|
|
/*
|
2010-02-15 18:03:34 +00:00
|
|
|
* linux/arch/arm/mach-omap2/hsmmc.c
|
2008-12-11 01:37:17 +00:00
|
|
|
*
|
|
|
|
* 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.
|
|
|
|
*/
|
2010-02-15 18:03:34 +00:00
|
|
|
#include <linux/kernel.h>
|
|
|
|
#include <linux/slab.h>
|
|
|
|
#include <linux/string.h>
|
2008-12-11 01:37:17 +00:00
|
|
|
#include <linux/delay.h>
|
2011-07-04 11:10:00 +00:00
|
|
|
#include <linux/gpio.h>
|
2014-11-08 14:33:08 +00:00
|
|
|
#include <linux/mmc/host.h>
|
2012-08-30 22:37:24 +00:00
|
|
|
#include <linux/platform_data/gpio-omap.h>
|
2014-11-08 14:33:09 +00:00
|
|
|
#include <linux/platform_data/hsmmc-omap.h>
|
2012-08-30 22:37:24 +00:00
|
|
|
|
2012-10-05 20:25:59 +00:00
|
|
|
#include "soc.h"
|
2012-10-03 00:25:48 +00:00
|
|
|
#include "omap_device.h"
|
2012-10-03 23:36:40 +00:00
|
|
|
#include "omap-pm.h"
|
2008-12-11 01:37:17 +00:00
|
|
|
|
2010-02-15 18:03:34 +00:00
|
|
|
#include "hsmmc.h"
|
2010-10-08 17:40:20 +00:00
|
|
|
#include "control.h"
|
2008-12-11 01:37:17 +00:00
|
|
|
|
2016-08-11 19:29:45 +00:00
|
|
|
#if IS_ENABLED(CONFIG_MMC_OMAP_HS)
|
2008-12-11 01:37:17 +00:00
|
|
|
|
|
|
|
static u16 control_pbias_offset;
|
|
|
|
static u16 control_devconf1_offset;
|
|
|
|
|
|
|
|
#define HSMMC_NAME_LEN 9
|
|
|
|
|
2014-11-08 14:33:17 +00:00
|
|
|
static void omap_hsmmc1_before_set_reg(struct device *dev,
|
|
|
|
int power_on, int vdd)
|
2008-12-11 01:37:17 +00:00
|
|
|
{
|
2009-11-22 18:11:08 +00:00
|
|
|
u32 reg, prog_io;
|
2014-11-08 14:33:09 +00:00
|
|
|
struct omap_hsmmc_platform_data *mmc = dev->platform_data;
|
2008-12-11 01:37:17 +00:00
|
|
|
|
2014-11-08 14:33:14 +00:00
|
|
|
if (mmc->remux)
|
2014-11-08 14:33:17 +00:00
|
|
|
mmc->remux(dev, power_on);
|
2010-02-15 18:03:34 +00:00
|
|
|
|
2009-03-24 01:23:47 +00:00
|
|
|
/*
|
|
|
|
* Assume we power both OMAP VMMC1 (for CMD, CLK, DAT0..3) and the
|
2009-05-28 21:04:03 +00:00
|
|
|
* card with Vcc regulator (from twl4030 or whatever). OMAP has both
|
2009-03-24 01:23:47 +00:00
|
|
|
* 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.
|
2009-05-28 21:04:03 +00:00
|
|
|
*
|
|
|
|
* FIXME handle VMMC1A as needed ...
|
2009-03-24 01:23:47 +00:00
|
|
|
*/
|
2008-12-11 01:37:17 +00:00
|
|
|
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);
|
|
|
|
}
|
|
|
|
|
2014-11-08 14:33:14 +00:00
|
|
|
if (mmc->internal_clock) {
|
2008-12-11 01:37:17 +00:00
|
|
|
reg = omap_ctrl_readl(OMAP2_CONTROL_DEVCONF0);
|
|
|
|
reg |= OMAP2_MMCSDIO1ADPCLKISEL;
|
|
|
|
omap_ctrl_writel(reg, OMAP2_CONTROL_DEVCONF0);
|
|
|
|
}
|
|
|
|
|
|
|
|
reg = omap_ctrl_readl(control_pbias_offset);
|
2009-11-22 18:11:08 +00:00
|
|
|
if (cpu_is_omap3630()) {
|
2015-05-14 15:18:46 +00:00
|
|
|
/* Set MMC I/O to 52MHz */
|
2009-11-22 18:11:08 +00:00
|
|
|
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;
|
|
|
|
}
|
2008-12-11 01:37:17 +00:00
|
|
|
reg &= ~OMAP2_PBIASLITEPWRDNZ0;
|
|
|
|
omap_ctrl_writel(reg, control_pbias_offset);
|
2010-02-15 18:03:34 +00:00
|
|
|
} else {
|
|
|
|
reg = omap_ctrl_readl(control_pbias_offset);
|
|
|
|
reg &= ~OMAP2_PBIASLITEPWRDNZ0;
|
|
|
|
omap_ctrl_writel(reg, control_pbias_offset);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2014-11-08 14:33:17 +00:00
|
|
|
static void omap_hsmmc1_after_set_reg(struct device *dev, int power_on, int vdd)
|
2010-02-15 18:03:34 +00:00
|
|
|
{
|
|
|
|
u32 reg;
|
2008-12-11 01:37:17 +00:00
|
|
|
|
2010-02-15 18:03:34 +00:00
|
|
|
/* 100ms delay required for PBIAS configuration */
|
|
|
|
msleep(100);
|
2008-12-11 01:37:17 +00:00
|
|
|
|
2010-02-15 18:03:34 +00:00
|
|
|
if (power_on) {
|
2008-12-11 01:37:17 +00:00
|
|
|
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);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2014-11-08 14:33:09 +00:00
|
|
|
static void hsmmc2_select_input_clk_src(struct omap_hsmmc_platform_data *mmc)
|
2011-11-29 09:37:48 +00:00
|
|
|
{
|
|
|
|
u32 reg;
|
|
|
|
|
2012-01-12 14:26:45 +00:00
|
|
|
reg = omap_ctrl_readl(control_devconf1_offset);
|
2014-11-08 14:33:14 +00:00
|
|
|
if (mmc->internal_clock)
|
2011-11-29 09:37:48 +00:00
|
|
|
reg |= OMAP2_MMCSDIO2ADPCLKISEL;
|
2012-01-12 14:26:45 +00:00
|
|
|
else
|
|
|
|
reg &= ~OMAP2_MMCSDIO2ADPCLKISEL;
|
|
|
|
omap_ctrl_writel(reg, control_devconf1_offset);
|
2011-11-29 09:37:48 +00:00
|
|
|
}
|
|
|
|
|
2014-11-08 14:33:17 +00:00
|
|
|
static void hsmmc2_before_set_reg(struct device *dev, int power_on, int vdd)
|
2008-12-11 01:37:17 +00:00
|
|
|
{
|
2014-11-08 14:33:09 +00:00
|
|
|
struct omap_hsmmc_platform_data *mmc = dev->platform_data;
|
2009-05-28 21:04:03 +00:00
|
|
|
|
2014-11-08 14:33:14 +00:00
|
|
|
if (mmc->remux)
|
2014-11-08 14:33:17 +00:00
|
|
|
mmc->remux(dev, power_on);
|
2010-02-15 18:03:34 +00:00
|
|
|
|
2011-11-29 09:37:48 +00:00
|
|
|
if (power_on)
|
|
|
|
hsmmc2_select_input_clk_src(mmc);
|
|
|
|
}
|
2008-12-11 01:37:17 +00:00
|
|
|
|
2014-11-08 14:33:17 +00:00
|
|
|
static int am35x_hsmmc2_set_power(struct device *dev, int power_on, int vdd)
|
2011-11-29 09:37:48 +00:00
|
|
|
{
|
2014-11-08 14:33:09 +00:00
|
|
|
struct omap_hsmmc_platform_data *mmc = dev->platform_data;
|
2011-11-29 09:37:48 +00:00
|
|
|
|
|
|
|
if (power_on)
|
|
|
|
hsmmc2_select_input_clk_src(mmc);
|
|
|
|
|
|
|
|
return 0;
|
2009-09-22 23:44:50 +00:00
|
|
|
}
|
|
|
|
|
2014-11-08 14:33:17 +00:00
|
|
|
static int nop_mmc_set_power(struct device *dev, int power_on, int vdd)
|
2010-05-13 12:39:31 +00:00
|
|
|
{
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2012-02-20 17:43:30 +00:00
|
|
|
static int __init omap_hsmmc_pdata_init(struct omap2_hsmmc_info *c,
|
2014-11-08 14:33:09 +00:00
|
|
|
struct omap_hsmmc_platform_data *mmc)
|
2011-02-28 15:18:04 +00:00
|
|
|
{
|
|
|
|
char *hc_name;
|
|
|
|
|
|
|
|
hc_name = kzalloc(sizeof(char) * (HSMMC_NAME_LEN + 1), GFP_KERNEL);
|
|
|
|
if (!hc_name) {
|
|
|
|
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);
|
2014-11-08 14:33:14 +00:00
|
|
|
mmc->name = hc_name;
|
|
|
|
mmc->caps = c->caps;
|
|
|
|
mmc->internal_clock = !c->ext_clock;
|
2013-05-30 19:53:06 +00:00
|
|
|
mmc->reg_offset = 0;
|
2011-02-28 15:18:04 +00:00
|
|
|
|
2015-03-20 14:53:54 +00:00
|
|
|
if (c->cover_only) {
|
|
|
|
/* detect if mobile phone cover removed */
|
|
|
|
mmc->gpio_cd = -EINVAL;
|
|
|
|
mmc->gpio_cod = c->gpio_cd;
|
|
|
|
} else {
|
|
|
|
/* card detect pin on the mmc socket itself */
|
|
|
|
mmc->gpio_cd = c->gpio_cd;
|
|
|
|
mmc->gpio_cod = -EINVAL;
|
|
|
|
}
|
2014-11-08 14:33:14 +00:00
|
|
|
mmc->gpio_wp = c->gpio_wp;
|
2011-02-28 15:18:04 +00:00
|
|
|
|
2014-11-08 14:33:14 +00:00
|
|
|
mmc->remux = c->remux;
|
|
|
|
mmc->init_card = c->init_card;
|
2011-02-28 15:18:04 +00:00
|
|
|
|
|
|
|
if (c->nonremovable)
|
2014-11-08 14:33:14 +00:00
|
|
|
mmc->nonremovable = 1;
|
2011-02-28 15:18:04 +00:00
|
|
|
|
|
|
|
/*
|
|
|
|
* 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
|
|
|
|
*/
|
2012-04-30 23:37:10 +00:00
|
|
|
if (soc_is_am35xx())
|
2014-11-08 14:33:14 +00:00
|
|
|
mmc->ocr_mask = MMC_VDD_165_195 |
|
2011-12-09 20:27:36 +00:00
|
|
|
MMC_VDD_26_27 |
|
|
|
|
MMC_VDD_27_28 |
|
|
|
|
MMC_VDD_29_30 |
|
|
|
|
MMC_VDD_30_31 |
|
|
|
|
MMC_VDD_31_32;
|
|
|
|
else
|
2014-11-08 14:33:14 +00:00
|
|
|
mmc->ocr_mask = c->ocr_mask;
|
2011-02-28 15:18:04 +00:00
|
|
|
|
2012-04-30 23:37:10 +00:00
|
|
|
if (!soc_is_am35xx())
|
2014-11-08 14:33:14 +00:00
|
|
|
mmc->features |= HSMMC_HAS_PBIAS;
|
2011-02-28 15:18:04 +00:00
|
|
|
|
|
|
|
switch (c->mmc) {
|
|
|
|
case 1:
|
2014-11-08 14:33:14 +00:00
|
|
|
if (mmc->features & HSMMC_HAS_PBIAS) {
|
2011-02-28 15:18:04 +00:00
|
|
|
/* on-chip level shifting via PBIAS0/PBIAS1 */
|
2014-11-08 14:33:14 +00:00
|
|
|
mmc->before_set_reg =
|
2013-05-30 19:53:06 +00:00
|
|
|
omap_hsmmc1_before_set_reg;
|
2014-11-08 14:33:14 +00:00
|
|
|
mmc->after_set_reg =
|
2013-05-30 19:53:06 +00:00
|
|
|
omap_hsmmc1_after_set_reg;
|
2011-02-28 15:18:04 +00:00
|
|
|
}
|
|
|
|
|
2012-04-30 23:37:10 +00:00
|
|
|
if (soc_is_am35xx())
|
2014-11-08 14:33:14 +00:00
|
|
|
mmc->set_power = nop_mmc_set_power;
|
2011-11-29 09:37:48 +00:00
|
|
|
|
2011-02-28 15:18:04 +00:00
|
|
|
/* 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;
|
2014-11-08 14:33:14 +00:00
|
|
|
mmc->caps = c->caps;
|
2011-02-28 15:18:04 +00:00
|
|
|
}
|
|
|
|
break;
|
|
|
|
case 2:
|
2012-04-30 23:37:10 +00:00
|
|
|
if (soc_is_am35xx())
|
2014-11-08 14:33:14 +00:00
|
|
|
mmc->set_power = am35x_hsmmc2_set_power;
|
2011-11-29 09:37:48 +00:00
|
|
|
|
2011-02-28 15:18:04 +00:00
|
|
|
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;
|
|
|
|
}
|
2014-11-08 14:33:14 +00:00
|
|
|
if (mmc->features & HSMMC_HAS_PBIAS) {
|
2011-02-28 15:18:04 +00:00
|
|
|
/* off-chip level shifting, or none */
|
2014-11-08 14:33:14 +00:00
|
|
|
mmc->before_set_reg = hsmmc2_before_set_reg;
|
|
|
|
mmc->after_set_reg = NULL;
|
2011-02-28 15:18:04 +00:00
|
|
|
}
|
|
|
|
break;
|
2011-12-18 00:35:47 +00:00
|
|
|
case 3:
|
2011-02-28 15:18:04 +00:00
|
|
|
case 4:
|
|
|
|
case 5:
|
2014-11-08 14:33:14 +00:00
|
|
|
mmc->before_set_reg = NULL;
|
|
|
|
mmc->after_set_reg = NULL;
|
2011-02-28 15:18:04 +00:00
|
|
|
break;
|
|
|
|
default:
|
|
|
|
pr_err("MMC%d configuration not supported!\n", c->mmc);
|
|
|
|
kfree(hc_name);
|
|
|
|
return -ENODEV;
|
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2012-02-20 17:43:28 +00:00
|
|
|
static int omap_hsmmc_done;
|
2012-02-20 17:43:29 +00:00
|
|
|
|
|
|
|
void omap_hsmmc_late_init(struct omap2_hsmmc_info *c)
|
|
|
|
{
|
|
|
|
struct platform_device *pdev;
|
2014-11-08 14:33:09 +00:00
|
|
|
struct omap_hsmmc_platform_data *mmc_pdata;
|
2012-02-20 17:43:29 +00:00
|
|
|
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;
|
|
|
|
|
2015-03-20 14:53:54 +00:00
|
|
|
if (c->cover_only) {
|
|
|
|
/* detect if mobile phone cover removed */
|
|
|
|
mmc_pdata->gpio_cd = -EINVAL;
|
|
|
|
mmc_pdata->gpio_cod = c->gpio_cd;
|
|
|
|
} else {
|
|
|
|
/* card detect pin on the mmc socket itself */
|
|
|
|
mmc_pdata->gpio_cd = c->gpio_cd;
|
|
|
|
mmc_pdata->gpio_cod = -EINVAL;
|
|
|
|
}
|
2014-11-08 14:33:14 +00:00
|
|
|
mmc_pdata->gpio_wp = c->gpio_wp;
|
2012-02-20 17:43:29 +00:00
|
|
|
|
|
|
|
res = omap_device_register(pdev);
|
|
|
|
if (res)
|
|
|
|
pr_err("Could not late init MMC %s\n",
|
|
|
|
c->name);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2011-02-28 15:18:04 +00:00
|
|
|
#define MAX_OMAP_MMC_HWMOD_NAME_LEN 16
|
|
|
|
|
2012-03-08 02:54:24 +00:00
|
|
|
static void __init omap_hsmmc_init_one(struct omap2_hsmmc_info *hsmmcinfo,
|
2012-02-20 17:43:29 +00:00
|
|
|
int ctrl_nr)
|
2011-02-28 15:18:04 +00:00
|
|
|
{
|
|
|
|
struct omap_hwmod *oh;
|
2012-02-20 17:43:29 +00:00
|
|
|
struct omap_hwmod *ohs[1];
|
|
|
|
struct omap_device *od;
|
2011-07-21 20:48:45 +00:00
|
|
|
struct platform_device *pdev;
|
2011-02-28 15:18:04 +00:00
|
|
|
char oh_name[MAX_OMAP_MMC_HWMOD_NAME_LEN];
|
2014-11-08 14:33:09 +00:00
|
|
|
struct omap_hsmmc_platform_data *mmc_data;
|
|
|
|
struct omap_hsmmc_dev_attr *mmc_dev_attr;
|
2011-02-28 15:18:04 +00:00
|
|
|
char *name;
|
2012-02-20 17:43:29 +00:00
|
|
|
int res;
|
2011-02-28 15:18:04 +00:00
|
|
|
|
2014-11-08 14:33:09 +00:00
|
|
|
mmc_data = kzalloc(sizeof(*mmc_data), GFP_KERNEL);
|
2017-06-03 15:24:27 +00:00
|
|
|
if (!mmc_data)
|
2012-02-20 17:43:29 +00:00
|
|
|
return;
|
2011-02-28 15:18:04 +00:00
|
|
|
|
2012-02-20 17:43:29 +00:00
|
|
|
res = omap_hsmmc_pdata_init(hsmmcinfo, mmc_data);
|
|
|
|
if (res < 0)
|
|
|
|
goto free_mmc;
|
|
|
|
|
2011-02-28 15:18:05 +00:00
|
|
|
name = "omap_hsmmc";
|
2012-02-20 17:43:29 +00:00
|
|
|
res = snprintf(oh_name, MAX_OMAP_MMC_HWMOD_NAME_LEN,
|
2011-02-28 15:18:04 +00:00
|
|
|
"mmc%d", ctrl_nr);
|
2012-02-20 17:43:29 +00:00
|
|
|
WARN(res >= MAX_OMAP_MMC_HWMOD_NAME_LEN,
|
2011-02-28 15:18:04 +00:00
|
|
|
"String buffer overflow in MMC%d device setup\n", ctrl_nr);
|
2012-02-20 17:43:29 +00:00
|
|
|
|
2011-02-28 15:18:04 +00:00
|
|
|
oh = omap_hwmod_lookup(oh_name);
|
|
|
|
if (!oh) {
|
|
|
|
pr_err("Could not look up %s\n", oh_name);
|
2012-02-20 17:43:29 +00:00
|
|
|
goto free_name;
|
2011-02-28 15:18:04 +00:00
|
|
|
}
|
2012-02-20 17:43:29 +00:00
|
|
|
ohs[0] = oh;
|
2011-02-28 15:18:04 +00:00
|
|
|
if (oh->dev_attr != NULL) {
|
|
|
|
mmc_dev_attr = oh->dev_attr;
|
|
|
|
mmc_data->controller_flags = mmc_dev_attr->flags;
|
2012-03-16 12:49:54 +00:00
|
|
|
/*
|
|
|
|
* 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;
|
2011-02-28 15:18:04 +00:00
|
|
|
}
|
|
|
|
|
2012-02-20 17:43:29 +00:00
|
|
|
pdev = platform_device_alloc(name, ctrl_nr - 1);
|
|
|
|
if (!pdev) {
|
|
|
|
pr_err("Could not allocate pdev for %s\n", name);
|
|
|
|
goto free_name;
|
2011-02-28 15:18:04 +00:00
|
|
|
}
|
2012-02-20 17:43:29 +00:00
|
|
|
dev_set_name(&pdev->dev, "%s.%d", pdev->name, pdev->id);
|
|
|
|
|
2013-01-26 07:48:53 +00:00
|
|
|
od = omap_device_alloc(pdev, ohs, 1);
|
2012-09-21 06:30:50 +00:00
|
|
|
if (IS_ERR(od)) {
|
2012-02-20 17:43:29 +00:00
|
|
|
pr_err("Could not allocate od for %s\n", name);
|
|
|
|
goto put_pdev;
|
|
|
|
}
|
|
|
|
|
|
|
|
res = platform_device_add_data(pdev, mmc_data,
|
2014-11-08 14:33:09 +00:00
|
|
|
sizeof(struct omap_hsmmc_platform_data));
|
2012-02-20 17:43:29 +00:00
|
|
|
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:
|
2014-11-08 14:33:14 +00:00
|
|
|
kfree(mmc_data->name);
|
2011-02-28 15:18:04 +00:00
|
|
|
|
2012-02-20 17:43:29 +00:00
|
|
|
free_mmc:
|
2011-02-28 15:18:04 +00:00
|
|
|
kfree(mmc_data);
|
|
|
|
}
|
2008-12-11 01:37:17 +00:00
|
|
|
|
2012-02-20 17:43:30 +00:00
|
|
|
void __init omap_hsmmc_init(struct omap2_hsmmc_info *controllers)
|
2008-12-11 01:37:17 +00:00
|
|
|
{
|
2012-02-20 17:43:28 +00:00
|
|
|
if (omap_hsmmc_done)
|
|
|
|
return;
|
|
|
|
|
|
|
|
omap_hsmmc_done = 1;
|
|
|
|
|
2013-05-30 19:53:06 +00:00
|
|
|
if (cpu_is_omap2430()) {
|
|
|
|
control_pbias_offset = OMAP243X_CONTROL_PBIAS_LITE;
|
|
|
|
control_devconf1_offset = OMAP243X_CONTROL_DEVCONF1;
|
2008-12-11 01:37:17 +00:00
|
|
|
} else {
|
2013-05-30 19:53:06 +00:00
|
|
|
control_pbias_offset = OMAP343X_CONTROL_PBIAS_LITE;
|
|
|
|
control_devconf1_offset = OMAP343X_CONTROL_DEVCONF1;
|
2008-12-11 01:37:17 +00:00
|
|
|
}
|
|
|
|
|
2011-02-28 15:18:04 +00:00
|
|
|
for (; controllers->mmc; controllers++)
|
2012-02-20 17:43:29 +00:00
|
|
|
omap_hsmmc_init_one(controllers, controllers->mmc);
|
2009-03-24 01:23:47 +00:00
|
|
|
|
2008-12-11 01:37:17 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
#endif
|