]>
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> | |
5a0e3ad6 | 16 | #include <linux/slab.h> |
e29a7d73 PO |
17 | |
18 | #include <linux/mmc/card.h> | |
19 | #include <linux/mmc/sdio_func.h> | |
20 | ||
b1538bcf | 21 | #include "sdio_cis.h" |
e29a7d73 PO |
22 | #include "sdio_bus.h" |
23 | ||
bcfe66e2 PO |
24 | /* show configuration fields */ |
25 | #define sdio_config_attr(field, format_string) \ | |
26 | static ssize_t \ | |
27 | field##_show(struct device *dev, struct device_attribute *attr, char *buf) \ | |
28 | { \ | |
29 | struct sdio_func *func; \ | |
30 | \ | |
31 | func = dev_to_sdio_func (dev); \ | |
32 | return sprintf (buf, format_string, func->field); \ | |
33 | } | |
34 | ||
35 | sdio_config_attr(class, "0x%02x\n"); | |
36 | sdio_config_attr(vendor, "0x%04x\n"); | |
37 | sdio_config_attr(device, "0x%04x\n"); | |
38 | ||
39 | static ssize_t modalias_show(struct device *dev, struct device_attribute *attr, char *buf) | |
40 | { | |
41 | struct sdio_func *func = dev_to_sdio_func (dev); | |
42 | ||
43 | return sprintf(buf, "sdio:c%02Xv%04Xd%04X\n", | |
44 | func->class, func->vendor, func->device); | |
45 | } | |
46 | ||
22bfc979 | 47 | static struct device_attribute sdio_dev_attrs[] = { |
bcfe66e2 PO |
48 | __ATTR_RO(class), |
49 | __ATTR_RO(vendor), | |
50 | __ATTR_RO(device), | |
51 | __ATTR_RO(modalias), | |
52 | __ATTR_NULL, | |
53 | }; | |
54 | ||
3b38bea0 PO |
55 | static const struct sdio_device_id *sdio_match_one(struct sdio_func *func, |
56 | const struct sdio_device_id *id) | |
57 | { | |
58 | if (id->class != (__u8)SDIO_ANY_ID && id->class != func->class) | |
59 | return NULL; | |
60 | if (id->vendor != (__u16)SDIO_ANY_ID && id->vendor != func->vendor) | |
61 | return NULL; | |
62 | if (id->device != (__u16)SDIO_ANY_ID && id->device != func->device) | |
63 | return NULL; | |
64 | return id; | |
65 | } | |
66 | ||
67 | static const struct sdio_device_id *sdio_match_device(struct sdio_func *func, | |
68 | struct sdio_driver *sdrv) | |
69 | { | |
70 | const struct sdio_device_id *ids; | |
71 | ||
72 | ids = sdrv->id_table; | |
73 | ||
74 | if (ids) { | |
75 | while (ids->class || ids->vendor || ids->device) { | |
76 | if (sdio_match_one(func, ids)) | |
77 | return ids; | |
78 | ids++; | |
79 | } | |
80 | } | |
81 | ||
82 | return NULL; | |
83 | } | |
e29a7d73 | 84 | |
e29a7d73 PO |
85 | static int sdio_bus_match(struct device *dev, struct device_driver *drv) |
86 | { | |
3b38bea0 PO |
87 | struct sdio_func *func = dev_to_sdio_func(dev); |
88 | struct sdio_driver *sdrv = to_sdio_driver(drv); | |
89 | ||
90 | if (sdio_match_device(func, sdrv)) | |
91 | return 1; | |
92 | ||
93 | return 0; | |
e29a7d73 PO |
94 | } |
95 | ||
96 | static int | |
7ac0326c | 97 | sdio_bus_uevent(struct device *dev, struct kobj_uevent_env *env) |
e29a7d73 | 98 | { |
d59b66c7 | 99 | struct sdio_func *func = dev_to_sdio_func(dev); |
d59b66c7 | 100 | |
7ac0326c | 101 | if (add_uevent_var(env, |
d59b66c7 PO |
102 | "SDIO_CLASS=%02X", func->class)) |
103 | return -ENOMEM; | |
104 | ||
7ac0326c | 105 | if (add_uevent_var(env, |
d59b66c7 PO |
106 | "SDIO_ID=%04X:%04X", func->vendor, func->device)) |
107 | return -ENOMEM; | |
108 | ||
7ac0326c | 109 | if (add_uevent_var(env, |
d59b66c7 PO |
110 | "MODALIAS=sdio:c%02Xv%04Xd%04X", |
111 | func->class, func->vendor, func->device)) | |
112 | return -ENOMEM; | |
113 | ||
e29a7d73 PO |
114 | return 0; |
115 | } | |
116 | ||
117 | static int sdio_bus_probe(struct device *dev) | |
118 | { | |
3b38bea0 PO |
119 | struct sdio_driver *drv = to_sdio_driver(dev->driver); |
120 | struct sdio_func *func = dev_to_sdio_func(dev); | |
121 | const struct sdio_device_id *id; | |
9a08f82b | 122 | int ret; |
3b38bea0 PO |
123 | |
124 | id = sdio_match_device(func, drv); | |
125 | if (!id) | |
126 | return -ENODEV; | |
127 | ||
9a08f82b DV |
128 | /* Set the default block size so the driver is sure it's something |
129 | * sensible. */ | |
130 | sdio_claim_host(func); | |
131 | ret = sdio_set_block_size(func, 0); | |
132 | sdio_release_host(func); | |
133 | if (ret) | |
134 | return ret; | |
135 | ||
3b38bea0 | 136 | return drv->probe(func, id); |
e29a7d73 PO |
137 | } |
138 | ||
139 | static int sdio_bus_remove(struct device *dev) | |
140 | { | |
3b38bea0 PO |
141 | struct sdio_driver *drv = to_sdio_driver(dev->driver); |
142 | struct sdio_func *func = dev_to_sdio_func(dev); | |
143 | ||
144 | drv->remove(func); | |
145 | ||
d1496c39 NP |
146 | if (func->irq_handler) { |
147 | printk(KERN_WARNING "WARNING: driver %s did not remove " | |
148 | "its interrupt handler!\n", drv->name); | |
149 | sdio_claim_host(func); | |
150 | sdio_release_irq(func); | |
151 | sdio_release_host(func); | |
152 | } | |
153 | ||
e29a7d73 PO |
154 | return 0; |
155 | } | |
156 | ||
157 | static struct bus_type sdio_bus_type = { | |
158 | .name = "sdio", | |
bcfe66e2 | 159 | .dev_attrs = sdio_dev_attrs, |
e29a7d73 PO |
160 | .match = sdio_bus_match, |
161 | .uevent = sdio_bus_uevent, | |
162 | .probe = sdio_bus_probe, | |
163 | .remove = sdio_bus_remove, | |
164 | }; | |
165 | ||
166 | int sdio_register_bus(void) | |
167 | { | |
168 | return bus_register(&sdio_bus_type); | |
169 | } | |
170 | ||
171 | void sdio_unregister_bus(void) | |
172 | { | |
173 | bus_unregister(&sdio_bus_type); | |
174 | } | |
175 | ||
f76c8515 PO |
176 | /** |
177 | * sdio_register_driver - register a function driver | |
178 | * @drv: SDIO function driver | |
179 | */ | |
180 | int sdio_register_driver(struct sdio_driver *drv) | |
181 | { | |
182 | drv->drv.name = drv->name; | |
183 | drv->drv.bus = &sdio_bus_type; | |
184 | return driver_register(&drv->drv); | |
185 | } | |
186 | EXPORT_SYMBOL_GPL(sdio_register_driver); | |
187 | ||
188 | /** | |
189 | * sdio_unregister_driver - unregister a function driver | |
190 | * @drv: SDIO function driver | |
191 | */ | |
192 | void sdio_unregister_driver(struct sdio_driver *drv) | |
193 | { | |
194 | drv->drv.bus = &sdio_bus_type; | |
195 | driver_unregister(&drv->drv); | |
196 | } | |
197 | EXPORT_SYMBOL_GPL(sdio_unregister_driver); | |
198 | ||
e29a7d73 PO |
199 | static void sdio_release_func(struct device *dev) |
200 | { | |
201 | struct sdio_func *func = dev_to_sdio_func(dev); | |
b1538bcf | 202 | |
1a632f8c | 203 | sdio_free_func_cis(func); |
e29a7d73 | 204 | |
759bdc7a PO |
205 | if (func->info) |
206 | kfree(func->info); | |
207 | ||
e29a7d73 PO |
208 | kfree(func); |
209 | } | |
210 | ||
211 | /* | |
212 | * Allocate and initialise a new SDIO function structure. | |
213 | */ | |
214 | struct sdio_func *sdio_alloc_func(struct mmc_card *card) | |
215 | { | |
216 | struct sdio_func *func; | |
217 | ||
9f2fcf99 | 218 | func = kzalloc(sizeof(struct sdio_func), GFP_KERNEL); |
e29a7d73 PO |
219 | if (!func) |
220 | return ERR_PTR(-ENOMEM); | |
221 | ||
e29a7d73 PO |
222 | func->card = card; |
223 | ||
224 | device_initialize(&func->dev); | |
225 | ||
226 | func->dev.parent = &card->dev; | |
227 | func->dev.bus = &sdio_bus_type; | |
228 | func->dev.release = sdio_release_func; | |
229 | ||
230 | return func; | |
231 | } | |
232 | ||
233 | /* | |
234 | * Register a new SDIO function with the driver model. | |
235 | */ | |
236 | int sdio_add_func(struct sdio_func *func) | |
237 | { | |
238 | int ret; | |
239 | ||
d1b26863 | 240 | dev_set_name(&func->dev, "%s:%d", mmc_card_id(func->card), func->num); |
e29a7d73 PO |
241 | |
242 | ret = device_add(&func->dev); | |
243 | if (ret == 0) | |
244 | sdio_func_set_present(func); | |
245 | ||
246 | return ret; | |
247 | } | |
248 | ||
249 | /* | |
250 | * Unregister a SDIO function with the driver model, and | |
251 | * (eventually) free it. | |
3d10a1ba DD |
252 | * This function can be called through error paths where sdio_add_func() was |
253 | * never executed (because a failure occurred at an earlier point). | |
e29a7d73 PO |
254 | */ |
255 | void sdio_remove_func(struct sdio_func *func) | |
256 | { | |
3d10a1ba DD |
257 | if (!sdio_func_present(func)) |
258 | return; | |
e29a7d73 | 259 | |
3d10a1ba | 260 | device_del(&func->dev); |
e29a7d73 PO |
261 | put_device(&func->dev); |
262 | } | |
263 |