]>
Commit | Line | Data |
---|---|---|
e29a7d73 PO |
1 | /* |
2 | * linux/drivers/mmc/core/sdio_bus.c | |
3 | * | |
4 | * Copyright 2007 Pierre Ossman | |
5 | * | |
6 | * This program is free software; you can redistribute it and/or modify | |
7 | * it under the terms of the GNU General Public License as published by | |
8 | * the Free Software Foundation; either version 2 of the License, or (at | |
9 | * your option) any later version. | |
10 | * | |
11 | * SDIO function driver model | |
12 | */ | |
13 | ||
14 | #include <linux/device.h> | |
15 | #include <linux/err.h> | |
3ef77af1 | 16 | #include <linux/export.h> |
5a0e3ad6 | 17 | #include <linux/slab.h> |
80fd933c | 18 | #include <linux/pm_runtime.h> |
f48c767c | 19 | #include <linux/pm_domain.h> |
eed222ac | 20 | #include <linux/acpi.h> |
e29a7d73 PO |
21 | |
22 | #include <linux/mmc/card.h> | |
ed919b01 | 23 | #include <linux/mmc/host.h> |
e29a7d73 | 24 | #include <linux/mmc/sdio_func.h> |
25185f3f | 25 | #include <linux/of.h> |
e29a7d73 | 26 | |
25185f3f | 27 | #include "core.h" |
4facdde1 | 28 | #include "card.h" |
b1538bcf | 29 | #include "sdio_cis.h" |
e29a7d73 PO |
30 | #include "sdio_bus.h" |
31 | ||
433b7b12 UH |
32 | #define to_sdio_driver(d) container_of(d, struct sdio_driver, drv) |
33 | ||
bcfe66e2 PO |
34 | /* show configuration fields */ |
35 | #define sdio_config_attr(field, format_string) \ | |
36 | static ssize_t \ | |
37 | field##_show(struct device *dev, struct device_attribute *attr, char *buf) \ | |
38 | { \ | |
39 | struct sdio_func *func; \ | |
40 | \ | |
41 | func = dev_to_sdio_func (dev); \ | |
42 | return sprintf (buf, format_string, func->field); \ | |
f24fc57b GKH |
43 | } \ |
44 | static DEVICE_ATTR_RO(field) | |
bcfe66e2 PO |
45 | |
46 | sdio_config_attr(class, "0x%02x\n"); | |
47 | sdio_config_attr(vendor, "0x%04x\n"); | |
48 | sdio_config_attr(device, "0x%04x\n"); | |
49 | ||
50 | static ssize_t modalias_show(struct device *dev, struct device_attribute *attr, char *buf) | |
51 | { | |
52 | struct sdio_func *func = dev_to_sdio_func (dev); | |
53 | ||
54 | return sprintf(buf, "sdio:c%02Xv%04Xd%04X\n", | |
55 | func->class, func->vendor, func->device); | |
56 | } | |
f24fc57b GKH |
57 | static DEVICE_ATTR_RO(modalias); |
58 | ||
59 | static struct attribute *sdio_dev_attrs[] = { | |
60 | &dev_attr_class.attr, | |
61 | &dev_attr_vendor.attr, | |
62 | &dev_attr_device.attr, | |
63 | &dev_attr_modalias.attr, | |
64 | NULL, | |
bcfe66e2 | 65 | }; |
f24fc57b | 66 | ATTRIBUTE_GROUPS(sdio_dev); |
bcfe66e2 | 67 | |
3b38bea0 PO |
68 | static const struct sdio_device_id *sdio_match_one(struct sdio_func *func, |
69 | const struct sdio_device_id *id) | |
70 | { | |
71 | if (id->class != (__u8)SDIO_ANY_ID && id->class != func->class) | |
72 | return NULL; | |
73 | if (id->vendor != (__u16)SDIO_ANY_ID && id->vendor != func->vendor) | |
74 | return NULL; | |
75 | if (id->device != (__u16)SDIO_ANY_ID && id->device != func->device) | |
76 | return NULL; | |
77 | return id; | |
78 | } | |
79 | ||
80 | static const struct sdio_device_id *sdio_match_device(struct sdio_func *func, | |
81 | struct sdio_driver *sdrv) | |
82 | { | |
83 | const struct sdio_device_id *ids; | |
84 | ||
85 | ids = sdrv->id_table; | |
86 | ||
87 | if (ids) { | |
88 | while (ids->class || ids->vendor || ids->device) { | |
89 | if (sdio_match_one(func, ids)) | |
90 | return ids; | |
91 | ids++; | |
92 | } | |
93 | } | |
94 | ||
95 | return NULL; | |
96 | } | |
e29a7d73 | 97 | |
e29a7d73 PO |
98 | static int sdio_bus_match(struct device *dev, struct device_driver *drv) |
99 | { | |
3b38bea0 PO |
100 | struct sdio_func *func = dev_to_sdio_func(dev); |
101 | struct sdio_driver *sdrv = to_sdio_driver(drv); | |
102 | ||
103 | if (sdio_match_device(func, sdrv)) | |
104 | return 1; | |
105 | ||
106 | return 0; | |
e29a7d73 PO |
107 | } |
108 | ||
109 | static int | |
7ac0326c | 110 | sdio_bus_uevent(struct device *dev, struct kobj_uevent_env *env) |
e29a7d73 | 111 | { |
d59b66c7 | 112 | struct sdio_func *func = dev_to_sdio_func(dev); |
d59b66c7 | 113 | |
7ac0326c | 114 | if (add_uevent_var(env, |
d59b66c7 PO |
115 | "SDIO_CLASS=%02X", func->class)) |
116 | return -ENOMEM; | |
117 | ||
7ac0326c | 118 | if (add_uevent_var(env, |
d59b66c7 PO |
119 | "SDIO_ID=%04X:%04X", func->vendor, func->device)) |
120 | return -ENOMEM; | |
121 | ||
7ac0326c | 122 | if (add_uevent_var(env, |
d59b66c7 PO |
123 | "MODALIAS=sdio:c%02Xv%04Xd%04X", |
124 | func->class, func->vendor, func->device)) | |
125 | return -ENOMEM; | |
126 | ||
e29a7d73 PO |
127 | return 0; |
128 | } | |
129 | ||
130 | static int sdio_bus_probe(struct device *dev) | |
131 | { | |
3b38bea0 PO |
132 | struct sdio_driver *drv = to_sdio_driver(dev->driver); |
133 | struct sdio_func *func = dev_to_sdio_func(dev); | |
134 | const struct sdio_device_id *id; | |
9a08f82b | 135 | int ret; |
3b38bea0 PO |
136 | |
137 | id = sdio_match_device(func, drv); | |
138 | if (!id) | |
139 | return -ENODEV; | |
140 | ||
1ef48e3d UH |
141 | ret = dev_pm_domain_attach(dev, false); |
142 | if (ret == -EPROBE_DEFER) | |
143 | return ret; | |
144 | ||
40bba0c1 OBC |
145 | /* Unbound SDIO functions are always suspended. |
146 | * During probe, the function is set active and the usage count | |
147 | * is incremented. If the driver supports runtime PM, | |
148 | * it should call pm_runtime_put_noidle() in its probe routine and | |
149 | * pm_runtime_get_noresume() in its remove routine. | |
150 | */ | |
ed919b01 OBC |
151 | if (func->card->host->caps & MMC_CAP_POWER_OFF_CARD) { |
152 | ret = pm_runtime_get_sync(dev); | |
153 | if (ret < 0) | |
3bffb800 | 154 | goto disable_runtimepm; |
ed919b01 | 155 | } |
40bba0c1 | 156 | |
9a08f82b DV |
157 | /* Set the default block size so the driver is sure it's something |
158 | * sensible. */ | |
159 | sdio_claim_host(func); | |
160 | ret = sdio_set_block_size(func, 0); | |
161 | sdio_release_host(func); | |
162 | if (ret) | |
40bba0c1 OBC |
163 | goto disable_runtimepm; |
164 | ||
165 | ret = drv->probe(func, id); | |
166 | if (ret) | |
167 | goto disable_runtimepm; | |
168 | ||
169 | return 0; | |
9a08f82b | 170 | |
40bba0c1 | 171 | disable_runtimepm: |
ed919b01 OBC |
172 | if (func->card->host->caps & MMC_CAP_POWER_OFF_CARD) |
173 | pm_runtime_put_noidle(dev); | |
1ef48e3d | 174 | dev_pm_domain_detach(dev, false); |
40bba0c1 | 175 | return ret; |
e29a7d73 PO |
176 | } |
177 | ||
178 | static int sdio_bus_remove(struct device *dev) | |
179 | { | |
3b38bea0 PO |
180 | struct sdio_driver *drv = to_sdio_driver(dev->driver); |
181 | struct sdio_func *func = dev_to_sdio_func(dev); | |
ed919b01 | 182 | int ret = 0; |
40bba0c1 OBC |
183 | |
184 | /* Make sure card is powered before invoking ->remove() */ | |
ecc02441 OBC |
185 | if (func->card->host->caps & MMC_CAP_POWER_OFF_CARD) |
186 | pm_runtime_get_sync(dev); | |
3b38bea0 PO |
187 | |
188 | drv->remove(func); | |
189 | ||
d1496c39 | 190 | if (func->irq_handler) { |
6606110d JP |
191 | pr_warn("WARNING: driver %s did not remove its interrupt handler!\n", |
192 | drv->name); | |
d1496c39 NP |
193 | sdio_claim_host(func); |
194 | sdio_release_irq(func); | |
195 | sdio_release_host(func); | |
196 | } | |
197 | ||
40bba0c1 | 198 | /* First, undo the increment made directly above */ |
ed919b01 OBC |
199 | if (func->card->host->caps & MMC_CAP_POWER_OFF_CARD) |
200 | pm_runtime_put_noidle(dev); | |
40bba0c1 OBC |
201 | |
202 | /* Then undo the runtime PM settings in sdio_bus_probe() */ | |
ed919b01 | 203 | if (func->card->host->caps & MMC_CAP_POWER_OFF_CARD) |
297c7f2f | 204 | pm_runtime_put_sync(dev); |
40bba0c1 | 205 | |
1ef48e3d UH |
206 | dev_pm_domain_detach(dev, false); |
207 | ||
40bba0c1 | 208 | return ret; |
e29a7d73 PO |
209 | } |
210 | ||
80fd933c | 211 | static const struct dev_pm_ops sdio_bus_pm_ops = { |
573185cc | 212 | SET_SYSTEM_SLEEP_PM_OPS(pm_generic_suspend, pm_generic_resume) |
80fd933c OBC |
213 | SET_RUNTIME_PM_OPS( |
214 | pm_generic_runtime_suspend, | |
215 | pm_generic_runtime_resume, | |
45f0a85c | 216 | NULL |
80fd933c OBC |
217 | ) |
218 | }; | |
219 | ||
e29a7d73 PO |
220 | static struct bus_type sdio_bus_type = { |
221 | .name = "sdio", | |
f24fc57b | 222 | .dev_groups = sdio_dev_groups, |
e29a7d73 PO |
223 | .match = sdio_bus_match, |
224 | .uevent = sdio_bus_uevent, | |
225 | .probe = sdio_bus_probe, | |
226 | .remove = sdio_bus_remove, | |
d99903ca | 227 | .pm = &sdio_bus_pm_ops, |
e29a7d73 PO |
228 | }; |
229 | ||
230 | int sdio_register_bus(void) | |
231 | { | |
232 | return bus_register(&sdio_bus_type); | |
233 | } | |
234 | ||
235 | void sdio_unregister_bus(void) | |
236 | { | |
237 | bus_unregister(&sdio_bus_type); | |
238 | } | |
239 | ||
f76c8515 PO |
240 | /** |
241 | * sdio_register_driver - register a function driver | |
242 | * @drv: SDIO function driver | |
243 | */ | |
244 | int sdio_register_driver(struct sdio_driver *drv) | |
245 | { | |
246 | drv->drv.name = drv->name; | |
247 | drv->drv.bus = &sdio_bus_type; | |
248 | return driver_register(&drv->drv); | |
249 | } | |
250 | EXPORT_SYMBOL_GPL(sdio_register_driver); | |
251 | ||
252 | /** | |
253 | * sdio_unregister_driver - unregister a function driver | |
254 | * @drv: SDIO function driver | |
255 | */ | |
256 | void sdio_unregister_driver(struct sdio_driver *drv) | |
257 | { | |
258 | drv->drv.bus = &sdio_bus_type; | |
259 | driver_unregister(&drv->drv); | |
260 | } | |
261 | EXPORT_SYMBOL_GPL(sdio_unregister_driver); | |
262 | ||
e29a7d73 PO |
263 | static void sdio_release_func(struct device *dev) |
264 | { | |
265 | struct sdio_func *func = dev_to_sdio_func(dev); | |
b1538bcf | 266 | |
1a632f8c | 267 | sdio_free_func_cis(func); |
e29a7d73 | 268 | |
4c42d6cc | 269 | kfree(func->info); |
5ef1ecf0 | 270 | kfree(func->tmpbuf); |
e29a7d73 PO |
271 | kfree(func); |
272 | } | |
273 | ||
274 | /* | |
275 | * Allocate and initialise a new SDIO function structure. | |
276 | */ | |
277 | struct sdio_func *sdio_alloc_func(struct mmc_card *card) | |
278 | { | |
279 | struct sdio_func *func; | |
280 | ||
9f2fcf99 | 281 | func = kzalloc(sizeof(struct sdio_func), GFP_KERNEL); |
e29a7d73 PO |
282 | if (!func) |
283 | return ERR_PTR(-ENOMEM); | |
284 | ||
5ef1ecf0 HK |
285 | /* |
286 | * allocate buffer separately to make sure it's properly aligned for | |
287 | * DMA usage (incl. 64 bit DMA) | |
288 | */ | |
289 | func->tmpbuf = kmalloc(4, GFP_KERNEL); | |
290 | if (!func->tmpbuf) { | |
291 | kfree(func); | |
292 | return ERR_PTR(-ENOMEM); | |
293 | } | |
294 | ||
e29a7d73 PO |
295 | func->card = card; |
296 | ||
297 | device_initialize(&func->dev); | |
298 | ||
299 | func->dev.parent = &card->dev; | |
300 | func->dev.bus = &sdio_bus_type; | |
301 | func->dev.release = sdio_release_func; | |
302 | ||
303 | return func; | |
304 | } | |
305 | ||
eed222ac AL |
306 | #ifdef CONFIG_ACPI |
307 | static void sdio_acpi_set_handle(struct sdio_func *func) | |
308 | { | |
309 | struct mmc_host *host = func->card->host; | |
51d34606 | 310 | u64 addr = ((u64)host->slotno << 16) | func->num; |
eed222ac | 311 | |
9c5ad36d | 312 | acpi_preset_companion(&func->dev, ACPI_COMPANION(host->parent), addr); |
eed222ac AL |
313 | } |
314 | #else | |
315 | static inline void sdio_acpi_set_handle(struct sdio_func *func) {} | |
316 | #endif | |
317 | ||
25185f3f SH |
318 | static void sdio_set_of_node(struct sdio_func *func) |
319 | { | |
320 | struct mmc_host *host = func->card->host; | |
321 | ||
322 | func->dev.of_node = mmc_of_find_child_device(host, func->num); | |
323 | } | |
324 | ||
e29a7d73 PO |
325 | /* |
326 | * Register a new SDIO function with the driver model. | |
327 | */ | |
328 | int sdio_add_func(struct sdio_func *func) | |
329 | { | |
330 | int ret; | |
331 | ||
d1b26863 | 332 | dev_set_name(&func->dev, "%s:%d", mmc_card_id(func->card), func->num); |
e29a7d73 | 333 | |
25185f3f | 334 | sdio_set_of_node(func); |
eed222ac | 335 | sdio_acpi_set_handle(func); |
ec076cd2 | 336 | device_enable_async_suspend(&func->dev); |
e29a7d73 | 337 | ret = device_add(&func->dev); |
1ef48e3d | 338 | if (ret == 0) |
e29a7d73 PO |
339 | sdio_func_set_present(func); |
340 | ||
341 | return ret; | |
342 | } | |
343 | ||
344 | /* | |
345 | * Unregister a SDIO function with the driver model, and | |
346 | * (eventually) free it. | |
3d10a1ba DD |
347 | * This function can be called through error paths where sdio_add_func() was |
348 | * never executed (because a failure occurred at an earlier point). | |
e29a7d73 PO |
349 | */ |
350 | void sdio_remove_func(struct sdio_func *func) | |
351 | { | |
3d10a1ba DD |
352 | if (!sdio_func_present(func)) |
353 | return; | |
e29a7d73 | 354 | |
3d10a1ba | 355 | device_del(&func->dev); |
25185f3f | 356 | of_node_put(func->dev.of_node); |
e29a7d73 PO |
357 | put_device(&func->dev); |
358 | } | |
359 |