2 * linux/drivers/mmc/core/sdio_bus.c
4 * Copyright 2007 Pierre Ossman
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.
11 * SDIO function driver model
14 #include <linux/device.h>
15 #include <linux/err.h>
17 #include <linux/mmc/card.h>
18 #include <linux/mmc/sdio_func.h>
23 #define dev_to_sdio_func(d) container_of(d, struct sdio_func, dev)
24 #define to_sdio_driver(d) container_of(d, struct sdio_driver, drv)
26 /* show configuration fields */
27 #define sdio_config_attr(field, format_string) \
29 field##_show(struct device *dev, struct device_attribute *attr, char *buf) \
31 struct sdio_func *func; \
33 func = dev_to_sdio_func (dev); \
34 return sprintf (buf, format_string, func->field); \
37 sdio_config_attr(class, "0x%02x\n");
38 sdio_config_attr(vendor
, "0x%04x\n");
39 sdio_config_attr(device
, "0x%04x\n");
41 static ssize_t
modalias_show(struct device
*dev
, struct device_attribute
*attr
, char *buf
)
43 struct sdio_func
*func
= dev_to_sdio_func (dev
);
45 return sprintf(buf
, "sdio:c%02Xv%04Xd%04X\n",
46 func
->class, func
->vendor
, func
->device
);
49 static struct device_attribute sdio_dev_attrs
[] = {
57 static const struct sdio_device_id
*sdio_match_one(struct sdio_func
*func
,
58 const struct sdio_device_id
*id
)
60 if (id
->class != (__u8
)SDIO_ANY_ID
&& id
->class != func
->class)
62 if (id
->vendor
!= (__u16
)SDIO_ANY_ID
&& id
->vendor
!= func
->vendor
)
64 if (id
->device
!= (__u16
)SDIO_ANY_ID
&& id
->device
!= func
->device
)
69 static const struct sdio_device_id
*sdio_match_device(struct sdio_func
*func
,
70 struct sdio_driver
*sdrv
)
72 const struct sdio_device_id
*ids
;
77 while (ids
->class || ids
->vendor
|| ids
->device
) {
78 if (sdio_match_one(func
, ids
))
87 static int sdio_bus_match(struct device
*dev
, struct device_driver
*drv
)
89 struct sdio_func
*func
= dev_to_sdio_func(dev
);
90 struct sdio_driver
*sdrv
= to_sdio_driver(drv
);
92 if (sdio_match_device(func
, sdrv
))
99 sdio_bus_uevent(struct device
*dev
, char **envp
, int num_envp
, char *buf
,
102 struct sdio_func
*func
= dev_to_sdio_func(dev
);
103 int i
= 0, length
= 0;
105 if (add_uevent_var(envp
, num_envp
, &i
,
106 buf
, buf_size
, &length
,
107 "SDIO_CLASS=%02X", func
->class))
110 if (add_uevent_var(envp
, num_envp
, &i
,
111 buf
, buf_size
, &length
,
112 "SDIO_ID=%04X:%04X", func
->vendor
, func
->device
))
115 if (add_uevent_var(envp
, num_envp
, &i
,
116 buf
, buf_size
, &length
,
117 "MODALIAS=sdio:c%02Xv%04Xd%04X",
118 func
->class, func
->vendor
, func
->device
))
126 static int sdio_bus_probe(struct device
*dev
)
128 struct sdio_driver
*drv
= to_sdio_driver(dev
->driver
);
129 struct sdio_func
*func
= dev_to_sdio_func(dev
);
130 const struct sdio_device_id
*id
;
132 id
= sdio_match_device(func
, drv
);
136 return drv
->probe(func
, id
);
139 static int sdio_bus_remove(struct device
*dev
)
141 struct sdio_driver
*drv
= to_sdio_driver(dev
->driver
);
142 struct sdio_func
*func
= dev_to_sdio_func(dev
);
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
);
157 static struct bus_type sdio_bus_type
= {
159 .dev_attrs
= sdio_dev_attrs
,
160 .match
= sdio_bus_match
,
161 .uevent
= sdio_bus_uevent
,
162 .probe
= sdio_bus_probe
,
163 .remove
= sdio_bus_remove
,
166 int sdio_register_bus(void)
168 return bus_register(&sdio_bus_type
);
171 void sdio_unregister_bus(void)
173 bus_unregister(&sdio_bus_type
);
177 * sdio_register_driver - register a function driver
178 * @drv: SDIO function driver
180 int sdio_register_driver(struct sdio_driver
*drv
)
182 drv
->drv
.name
= drv
->name
;
183 drv
->drv
.bus
= &sdio_bus_type
;
184 return driver_register(&drv
->drv
);
186 EXPORT_SYMBOL_GPL(sdio_register_driver
);
189 * sdio_unregister_driver - unregister a function driver
190 * @drv: SDIO function driver
192 void sdio_unregister_driver(struct sdio_driver
*drv
)
194 drv
->drv
.bus
= &sdio_bus_type
;
195 driver_unregister(&drv
->drv
);
197 EXPORT_SYMBOL_GPL(sdio_unregister_driver
);
199 static void sdio_release_func(struct device
*dev
)
201 struct sdio_func
*func
= dev_to_sdio_func(dev
);
203 sdio_free_func_cis(func
);
209 * Allocate and initialise a new SDIO function structure.
211 struct sdio_func
*sdio_alloc_func(struct mmc_card
*card
)
213 struct sdio_func
*func
;
215 func
= kmalloc(sizeof(struct sdio_func
), GFP_KERNEL
);
217 return ERR_PTR(-ENOMEM
);
219 memset(func
, 0, sizeof(struct sdio_func
));
223 device_initialize(&func
->dev
);
225 func
->dev
.parent
= &card
->dev
;
226 func
->dev
.bus
= &sdio_bus_type
;
227 func
->dev
.release
= sdio_release_func
;
233 * Register a new SDIO function with the driver model.
235 int sdio_add_func(struct sdio_func
*func
)
239 snprintf(func
->dev
.bus_id
, sizeof(func
->dev
.bus_id
),
240 "%s:%d", mmc_card_id(func
->card
), func
->num
);
242 ret
= device_add(&func
->dev
);
244 sdio_func_set_present(func
);
250 * Unregister a SDIO function with the driver model, and
251 * (eventually) free it.
253 void sdio_remove_func(struct sdio_func
*func
)
255 if (sdio_func_present(func
))
256 device_del(&func
->dev
);
258 put_device(&func
->dev
);