1 // SPDX-License-Identifier: GPL-2.0-only
3 * linux/arch/arm/mach-omap2/hsmmc.c
5 * Copyright (C) 2007-2008 Texas Instruments
6 * Copyright (C) 2008 Nokia Corporation
7 * Author: Texas Instruments
9 #include <linux/kernel.h>
10 #include <linux/slab.h>
11 #include <linux/string.h>
12 #include <linux/delay.h>
13 #include <linux/mmc/host.h>
14 #include <linux/platform_data/hsmmc-omap.h>
17 #include "omap_device.h"
22 #if IS_ENABLED(CONFIG_MMC_OMAP_HS)
24 static u16 control_pbias_offset
;
25 static u16 control_devconf1_offset
;
27 #define HSMMC_NAME_LEN 9
29 static int __init
omap_hsmmc_pdata_init(struct omap2_hsmmc_info
*c
,
30 struct omap_hsmmc_platform_data
*mmc
)
34 hc_name
= kzalloc(HSMMC_NAME_LEN
+ 1, GFP_KERNEL
);
40 snprintf(hc_name
, (HSMMC_NAME_LEN
+ 1), "mmc%islot%i", c
->mmc
, 1);
48 static int omap_hsmmc_done
;
50 void omap_hsmmc_late_init(struct omap2_hsmmc_info
*c
)
52 struct platform_device
*pdev
;
64 res
= omap_device_register(pdev
);
66 pr_err("Could not late init MMC\n");
70 #define MAX_OMAP_MMC_HWMOD_NAME_LEN 16
72 static void __init
omap_hsmmc_init_one(struct omap2_hsmmc_info
*hsmmcinfo
,
75 struct omap_hwmod
*oh
;
76 struct omap_hwmod
*ohs
[1];
77 struct omap_device
*od
;
78 struct platform_device
*pdev
;
79 char oh_name
[MAX_OMAP_MMC_HWMOD_NAME_LEN
];
80 struct omap_hsmmc_platform_data
*mmc_data
;
81 struct omap_hsmmc_dev_attr
*mmc_dev_attr
;
85 mmc_data
= kzalloc(sizeof(*mmc_data
), GFP_KERNEL
);
89 res
= omap_hsmmc_pdata_init(hsmmcinfo
, mmc_data
);
94 res
= snprintf(oh_name
, MAX_OMAP_MMC_HWMOD_NAME_LEN
,
96 WARN(res
>= MAX_OMAP_MMC_HWMOD_NAME_LEN
,
97 "String buffer overflow in MMC%d device setup\n", ctrl_nr
);
99 oh
= omap_hwmod_lookup(oh_name
);
101 pr_err("Could not look up %s\n", oh_name
);
105 if (oh
->dev_attr
!= NULL
) {
106 mmc_dev_attr
= oh
->dev_attr
;
107 mmc_data
->controller_flags
= mmc_dev_attr
->flags
;
110 pdev
= platform_device_alloc(name
, ctrl_nr
- 1);
112 pr_err("Could not allocate pdev for %s\n", name
);
115 dev_set_name(&pdev
->dev
, "%s.%d", pdev
->name
, pdev
->id
);
117 od
= omap_device_alloc(pdev
, ohs
, 1);
119 pr_err("Could not allocate od for %s\n", name
);
123 res
= platform_device_add_data(pdev
, mmc_data
,
124 sizeof(struct omap_hsmmc_platform_data
));
126 pr_err("Could not add pdata for %s\n", name
);
130 hsmmcinfo
->pdev
= pdev
;
132 res
= omap_device_register(pdev
);
134 pr_err("Could not register od for %s\n", name
);
141 omap_device_delete(od
);
144 platform_device_put(pdev
);
147 kfree(mmc_data
->name
);
153 void __init
omap_hsmmc_init(struct omap2_hsmmc_info
*controllers
)
160 if (cpu_is_omap2430()) {
161 control_pbias_offset
= OMAP243X_CONTROL_PBIAS_LITE
;
162 control_devconf1_offset
= OMAP243X_CONTROL_DEVCONF1
;
164 control_pbias_offset
= OMAP343X_CONTROL_PBIAS_LITE
;
165 control_devconf1_offset
= OMAP343X_CONTROL_DEVCONF1
;
168 for (; controllers
->mmc
; controllers
++)
169 omap_hsmmc_init_one(controllers
, controllers
->mmc
);