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 static const struct sdio_device_id
*sdio_match_one(struct sdio_func
*func
,
27 const struct sdio_device_id
*id
)
29 if (id
->class != (__u8
)SDIO_ANY_ID
&& id
->class != func
->class)
31 if (id
->vendor
!= (__u16
)SDIO_ANY_ID
&& id
->vendor
!= func
->vendor
)
33 if (id
->device
!= (__u16
)SDIO_ANY_ID
&& id
->device
!= func
->device
)
38 static const struct sdio_device_id
*sdio_match_device(struct sdio_func
*func
,
39 struct sdio_driver
*sdrv
)
41 const struct sdio_device_id
*ids
;
46 while (ids
->class || ids
->vendor
|| ids
->device
) {
47 if (sdio_match_one(func
, ids
))
56 static int sdio_bus_match(struct device
*dev
, struct device_driver
*drv
)
58 struct sdio_func
*func
= dev_to_sdio_func(dev
);
59 struct sdio_driver
*sdrv
= to_sdio_driver(drv
);
61 if (sdio_match_device(func
, sdrv
))
68 sdio_bus_uevent(struct device
*dev
, char **envp
, int num_envp
, char *buf
,
71 struct sdio_func
*func
= dev_to_sdio_func(dev
);
72 int i
= 0, length
= 0;
74 if (add_uevent_var(envp
, num_envp
, &i
,
75 buf
, buf_size
, &length
,
76 "SDIO_CLASS=%02X", func
->class))
79 if (add_uevent_var(envp
, num_envp
, &i
,
80 buf
, buf_size
, &length
,
81 "SDIO_ID=%04X:%04X", func
->vendor
, func
->device
))
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
))
95 static int sdio_bus_probe(struct device
*dev
)
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
;
101 id
= sdio_match_device(func
, drv
);
105 return drv
->probe(func
, id
);
108 static int sdio_bus_remove(struct device
*dev
)
110 struct sdio_driver
*drv
= to_sdio_driver(dev
->driver
);
111 struct sdio_func
*func
= dev_to_sdio_func(dev
);
118 static struct bus_type sdio_bus_type
= {
120 .match
= sdio_bus_match
,
121 .uevent
= sdio_bus_uevent
,
122 .probe
= sdio_bus_probe
,
123 .remove
= sdio_bus_remove
,
126 int sdio_register_bus(void)
128 return bus_register(&sdio_bus_type
);
131 void sdio_unregister_bus(void)
133 bus_unregister(&sdio_bus_type
);
137 * sdio_register_driver - register a function driver
138 * @drv: SDIO function driver
140 int sdio_register_driver(struct sdio_driver
*drv
)
142 drv
->drv
.name
= drv
->name
;
143 drv
->drv
.bus
= &sdio_bus_type
;
144 return driver_register(&drv
->drv
);
146 EXPORT_SYMBOL_GPL(sdio_register_driver
);
149 * sdio_unregister_driver - unregister a function driver
150 * @drv: SDIO function driver
152 void sdio_unregister_driver(struct sdio_driver
*drv
)
154 drv
->drv
.bus
= &sdio_bus_type
;
155 driver_unregister(&drv
->drv
);
157 EXPORT_SYMBOL_GPL(sdio_unregister_driver
);
159 static void sdio_release_func(struct device
*dev
)
161 struct sdio_func
*func
= dev_to_sdio_func(dev
);
163 sdio_free_func_cis(func
);
169 * Allocate and initialise a new SDIO function structure.
171 struct sdio_func
*sdio_alloc_func(struct mmc_card
*card
)
173 struct sdio_func
*func
;
175 func
= kmalloc(sizeof(struct sdio_func
), GFP_KERNEL
);
177 return ERR_PTR(-ENOMEM
);
179 memset(func
, 0, sizeof(struct sdio_func
));
183 device_initialize(&func
->dev
);
185 func
->dev
.parent
= &card
->dev
;
186 func
->dev
.bus
= &sdio_bus_type
;
187 func
->dev
.release
= sdio_release_func
;
193 * Register a new SDIO function with the driver model.
195 int sdio_add_func(struct sdio_func
*func
)
199 snprintf(func
->dev
.bus_id
, sizeof(func
->dev
.bus_id
),
200 "%s:%d", mmc_card_id(func
->card
), func
->num
);
202 ret
= device_add(&func
->dev
);
204 sdio_func_set_present(func
);
210 * Unregister a SDIO function with the driver model, and
211 * (eventually) free it.
213 void sdio_remove_func(struct sdio_func
*func
)
215 if (sdio_func_present(func
))
216 device_del(&func
->dev
);
218 put_device(&func
->dev
);
This page took 0.040742 seconds and 5 git commands to generate.