]>
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> | |
16 | ||
17 | #include <linux/mmc/card.h> | |
18 | #include <linux/mmc/sdio_func.h> | |
19 | ||
b1538bcf | 20 | #include "sdio_cis.h" |
e29a7d73 PO |
21 | #include "sdio_bus.h" |
22 | ||
23 | #define dev_to_sdio_func(d) container_of(d, struct sdio_func, dev) | |
3b38bea0 PO |
24 | #define to_sdio_driver(d) container_of(d, struct sdio_driver, drv) |
25 | ||
26 | static const struct sdio_device_id *sdio_match_one(struct sdio_func *func, | |
27 | const struct sdio_device_id *id) | |
28 | { | |
29 | if (id->class != (__u8)SDIO_ANY_ID && id->class != func->class) | |
30 | return NULL; | |
31 | if (id->vendor != (__u16)SDIO_ANY_ID && id->vendor != func->vendor) | |
32 | return NULL; | |
33 | if (id->device != (__u16)SDIO_ANY_ID && id->device != func->device) | |
34 | return NULL; | |
35 | return id; | |
36 | } | |
37 | ||
38 | static const struct sdio_device_id *sdio_match_device(struct sdio_func *func, | |
39 | struct sdio_driver *sdrv) | |
40 | { | |
41 | const struct sdio_device_id *ids; | |
42 | ||
43 | ids = sdrv->id_table; | |
44 | ||
45 | if (ids) { | |
46 | while (ids->class || ids->vendor || ids->device) { | |
47 | if (sdio_match_one(func, ids)) | |
48 | return ids; | |
49 | ids++; | |
50 | } | |
51 | } | |
52 | ||
53 | return NULL; | |
54 | } | |
e29a7d73 | 55 | |
e29a7d73 PO |
56 | static int sdio_bus_match(struct device *dev, struct device_driver *drv) |
57 | { | |
3b38bea0 PO |
58 | struct sdio_func *func = dev_to_sdio_func(dev); |
59 | struct sdio_driver *sdrv = to_sdio_driver(drv); | |
60 | ||
61 | if (sdio_match_device(func, sdrv)) | |
62 | return 1; | |
63 | ||
64 | return 0; | |
e29a7d73 PO |
65 | } |
66 | ||
67 | static int | |
68 | sdio_bus_uevent(struct device *dev, char **envp, int num_envp, char *buf, | |
69 | int buf_size) | |
70 | { | |
d59b66c7 PO |
71 | struct sdio_func *func = dev_to_sdio_func(dev); |
72 | int i = 0, length = 0; | |
73 | ||
74 | if (add_uevent_var(envp, num_envp, &i, | |
75 | buf, buf_size, &length, | |
76 | "SDIO_CLASS=%02X", func->class)) | |
77 | return -ENOMEM; | |
78 | ||
79 | if (add_uevent_var(envp, num_envp, &i, | |
80 | buf, buf_size, &length, | |
81 | "SDIO_ID=%04X:%04X", func->vendor, func->device)) | |
82 | return -ENOMEM; | |
83 | ||
84 | if (add_uevent_var(envp, num_envp, &i, | |
85 | buf, buf_size, &length, | |
86 | "MODALIAS=sdio:c%02Xv%04Xd%04X", | |
87 | func->class, func->vendor, func->device)) | |
88 | return -ENOMEM; | |
89 | ||
90 | envp[i] = NULL; | |
e29a7d73 PO |
91 | |
92 | return 0; | |
93 | } | |
94 | ||
95 | static int sdio_bus_probe(struct device *dev) | |
96 | { | |
3b38bea0 PO |
97 | struct sdio_driver *drv = to_sdio_driver(dev->driver); |
98 | struct sdio_func *func = dev_to_sdio_func(dev); | |
99 | const struct sdio_device_id *id; | |
100 | ||
101 | id = sdio_match_device(func, drv); | |
102 | if (!id) | |
103 | return -ENODEV; | |
104 | ||
105 | return drv->probe(func, id); | |
e29a7d73 PO |
106 | } |
107 | ||
108 | static int sdio_bus_remove(struct device *dev) | |
109 | { | |
3b38bea0 PO |
110 | struct sdio_driver *drv = to_sdio_driver(dev->driver); |
111 | struct sdio_func *func = dev_to_sdio_func(dev); | |
112 | ||
113 | drv->remove(func); | |
114 | ||
e29a7d73 PO |
115 | return 0; |
116 | } | |
117 | ||
118 | static struct bus_type sdio_bus_type = { | |
119 | .name = "sdio", | |
120 | .match = sdio_bus_match, | |
121 | .uevent = sdio_bus_uevent, | |
122 | .probe = sdio_bus_probe, | |
123 | .remove = sdio_bus_remove, | |
124 | }; | |
125 | ||
126 | int sdio_register_bus(void) | |
127 | { | |
128 | return bus_register(&sdio_bus_type); | |
129 | } | |
130 | ||
131 | void sdio_unregister_bus(void) | |
132 | { | |
133 | bus_unregister(&sdio_bus_type); | |
134 | } | |
135 | ||
f76c8515 PO |
136 | /** |
137 | * sdio_register_driver - register a function driver | |
138 | * @drv: SDIO function driver | |
139 | */ | |
140 | int sdio_register_driver(struct sdio_driver *drv) | |
141 | { | |
142 | drv->drv.name = drv->name; | |
143 | drv->drv.bus = &sdio_bus_type; | |
144 | return driver_register(&drv->drv); | |
145 | } | |
146 | EXPORT_SYMBOL_GPL(sdio_register_driver); | |
147 | ||
148 | /** | |
149 | * sdio_unregister_driver - unregister a function driver | |
150 | * @drv: SDIO function driver | |
151 | */ | |
152 | void sdio_unregister_driver(struct sdio_driver *drv) | |
153 | { | |
154 | drv->drv.bus = &sdio_bus_type; | |
155 | driver_unregister(&drv->drv); | |
156 | } | |
157 | EXPORT_SYMBOL_GPL(sdio_unregister_driver); | |
158 | ||
e29a7d73 PO |
159 | static void sdio_release_func(struct device *dev) |
160 | { | |
161 | struct sdio_func *func = dev_to_sdio_func(dev); | |
b1538bcf | 162 | |
1a632f8c | 163 | sdio_free_func_cis(func); |
e29a7d73 PO |
164 | |
165 | kfree(func); | |
166 | } | |
167 | ||
168 | /* | |
169 | * Allocate and initialise a new SDIO function structure. | |
170 | */ | |
171 | struct sdio_func *sdio_alloc_func(struct mmc_card *card) | |
172 | { | |
173 | struct sdio_func *func; | |
174 | ||
175 | func = kmalloc(sizeof(struct sdio_func), GFP_KERNEL); | |
176 | if (!func) | |
177 | return ERR_PTR(-ENOMEM); | |
178 | ||
179 | memset(func, 0, sizeof(struct sdio_func)); | |
180 | ||
181 | func->card = card; | |
182 | ||
183 | device_initialize(&func->dev); | |
184 | ||
185 | func->dev.parent = &card->dev; | |
186 | func->dev.bus = &sdio_bus_type; | |
187 | func->dev.release = sdio_release_func; | |
188 | ||
189 | return func; | |
190 | } | |
191 | ||
192 | /* | |
193 | * Register a new SDIO function with the driver model. | |
194 | */ | |
195 | int sdio_add_func(struct sdio_func *func) | |
196 | { | |
197 | int ret; | |
198 | ||
199 | snprintf(func->dev.bus_id, sizeof(func->dev.bus_id), | |
200 | "%s:%d", mmc_card_id(func->card), func->num); | |
201 | ||
202 | ret = device_add(&func->dev); | |
203 | if (ret == 0) | |
204 | sdio_func_set_present(func); | |
205 | ||
206 | return ret; | |
207 | } | |
208 | ||
209 | /* | |
210 | * Unregister a SDIO function with the driver model, and | |
211 | * (eventually) free it. | |
212 | */ | |
213 | void sdio_remove_func(struct sdio_func *func) | |
214 | { | |
215 | if (sdio_func_present(func)) | |
216 | device_del(&func->dev); | |
217 | ||
218 | put_device(&func->dev); | |
219 | } | |
220 |