2 * linux/arch/arm/mach-omap2/hsmmc.c
4 * Copyright (C) 2007-2008 Texas Instruments
5 * Copyright (C) 2008 Nokia Corporation
6 * Author: Texas Instruments
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License version 2 as
10 * published by the Free Software Foundation.
12 #include <linux/kernel.h>
13 #include <linux/slab.h>
14 #include <linux/string.h>
15 #include <linux/delay.h>
16 #include <linux/gpio.h>
17 #include <linux/mmc/host.h>
18 #include <linux/platform_data/gpio-omap.h>
19 #include <linux/platform_data/hsmmc-omap.h>
22 #include "omap_device.h"
28 #if IS_ENABLED(CONFIG_MMC_OMAP_HS)
30 static u16 control_pbias_offset;
31 static u16 control_devconf1_offset;
33 #define HSMMC_NAME_LEN 9
35 static int __init omap_hsmmc_pdata_init(struct omap2_hsmmc_info *c,
36 struct omap_hsmmc_platform_data *mmc)
40 hc_name = kzalloc(sizeof(char) * (HSMMC_NAME_LEN + 1), GFP_KERNEL);
46 snprintf(hc_name, (HSMMC_NAME_LEN + 1), "mmc%islot%i", c->mmc, 1);
54 static int omap_hsmmc_done;
56 void omap_hsmmc_late_init(struct omap2_hsmmc_info *c)
58 struct platform_device *pdev;
70 res = omap_device_register(pdev);
72 pr_err("Could not late init MMC\n");
76 #define MAX_OMAP_MMC_HWMOD_NAME_LEN 16
78 static void __init omap_hsmmc_init_one(struct omap2_hsmmc_info *hsmmcinfo,
81 struct omap_hwmod *oh;
82 struct omap_hwmod *ohs[1];
83 struct omap_device *od;
84 struct platform_device *pdev;
85 char oh_name[MAX_OMAP_MMC_HWMOD_NAME_LEN];
86 struct omap_hsmmc_platform_data *mmc_data;
87 struct omap_hsmmc_dev_attr *mmc_dev_attr;
91 mmc_data = kzalloc(sizeof(*mmc_data), GFP_KERNEL);
95 res = omap_hsmmc_pdata_init(hsmmcinfo, mmc_data);
100 res = snprintf(oh_name, MAX_OMAP_MMC_HWMOD_NAME_LEN,
102 WARN(res >= MAX_OMAP_MMC_HWMOD_NAME_LEN,
103 "String buffer overflow in MMC%d device setup\n", ctrl_nr);
105 oh = omap_hwmod_lookup(oh_name);
107 pr_err("Could not look up %s\n", oh_name);
111 if (oh->dev_attr != NULL) {
112 mmc_dev_attr = oh->dev_attr;
113 mmc_data->controller_flags = mmc_dev_attr->flags;
116 pdev = platform_device_alloc(name, ctrl_nr - 1);
118 pr_err("Could not allocate pdev for %s\n", name);
121 dev_set_name(&pdev->dev, "%s.%d", pdev->name, pdev->id);
123 od = omap_device_alloc(pdev, ohs, 1);
125 pr_err("Could not allocate od for %s\n", name);
129 res = platform_device_add_data(pdev, mmc_data,
130 sizeof(struct omap_hsmmc_platform_data));
132 pr_err("Could not add pdata for %s\n", name);
136 hsmmcinfo->pdev = pdev;
138 res = omap_device_register(pdev);
140 pr_err("Could not register od for %s\n", name);
147 omap_device_delete(od);
150 platform_device_put(pdev);
153 kfree(mmc_data->name);
159 void __init omap_hsmmc_init(struct omap2_hsmmc_info *controllers)
166 if (cpu_is_omap2430()) {
167 control_pbias_offset = OMAP243X_CONTROL_PBIAS_LITE;
168 control_devconf1_offset = OMAP243X_CONTROL_DEVCONF1;
170 control_pbias_offset = OMAP343X_CONTROL_PBIAS_LITE;
171 control_devconf1_offset = OMAP343X_CONTROL_DEVCONF1;
174 for (; controllers->mmc; controllers++)
175 omap_hsmmc_init_one(controllers, controllers->mmc);