sdio_bus.c revision 22bfc979d38f57d5b10d141990175d8fc47f6775
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 20#include "sdio_cis.h" 21#include "sdio_bus.h" 22 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) 25 26/* show configuration fields */ 27#define sdio_config_attr(field, format_string) \ 28static ssize_t \ 29field##_show(struct device *dev, struct device_attribute *attr, char *buf) \ 30{ \ 31 struct sdio_func *func; \ 32 \ 33 func = dev_to_sdio_func (dev); \ 34 return sprintf (buf, format_string, func->field); \ 35} 36 37sdio_config_attr(class, "0x%02x\n"); 38sdio_config_attr(vendor, "0x%04x\n"); 39sdio_config_attr(device, "0x%04x\n"); 40 41static ssize_t modalias_show(struct device *dev, struct device_attribute *attr, char *buf) 42{ 43 struct sdio_func *func = dev_to_sdio_func (dev); 44 45 return sprintf(buf, "sdio:c%02Xv%04Xd%04X\n", 46 func->class, func->vendor, func->device); 47} 48 49static struct device_attribute sdio_dev_attrs[] = { 50 __ATTR_RO(class), 51 __ATTR_RO(vendor), 52 __ATTR_RO(device), 53 __ATTR_RO(modalias), 54 __ATTR_NULL, 55}; 56 57static const struct sdio_device_id *sdio_match_one(struct sdio_func *func, 58 const struct sdio_device_id *id) 59{ 60 if (id->class != (__u8)SDIO_ANY_ID && id->class != func->class) 61 return NULL; 62 if (id->vendor != (__u16)SDIO_ANY_ID && id->vendor != func->vendor) 63 return NULL; 64 if (id->device != (__u16)SDIO_ANY_ID && id->device != func->device) 65 return NULL; 66 return id; 67} 68 69static const struct sdio_device_id *sdio_match_device(struct sdio_func *func, 70 struct sdio_driver *sdrv) 71{ 72 const struct sdio_device_id *ids; 73 74 ids = sdrv->id_table; 75 76 if (ids) { 77 while (ids->class || ids->vendor || ids->device) { 78 if (sdio_match_one(func, ids)) 79 return ids; 80 ids++; 81 } 82 } 83 84 return NULL; 85} 86 87static int sdio_bus_match(struct device *dev, struct device_driver *drv) 88{ 89 struct sdio_func *func = dev_to_sdio_func(dev); 90 struct sdio_driver *sdrv = to_sdio_driver(drv); 91 92 if (sdio_match_device(func, sdrv)) 93 return 1; 94 95 return 0; 96} 97 98static int 99sdio_bus_uevent(struct device *dev, char **envp, int num_envp, char *buf, 100 int buf_size) 101{ 102 struct sdio_func *func = dev_to_sdio_func(dev); 103 int i = 0, length = 0; 104 105 if (add_uevent_var(envp, num_envp, &i, 106 buf, buf_size, &length, 107 "SDIO_CLASS=%02X", func->class)) 108 return -ENOMEM; 109 110 if (add_uevent_var(envp, num_envp, &i, 111 buf, buf_size, &length, 112 "SDIO_ID=%04X:%04X", func->vendor, func->device)) 113 return -ENOMEM; 114 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)) 119 return -ENOMEM; 120 121 envp[i] = NULL; 122 123 return 0; 124} 125 126static int sdio_bus_probe(struct device *dev) 127{ 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; 131 132 id = sdio_match_device(func, drv); 133 if (!id) 134 return -ENODEV; 135 136 return drv->probe(func, id); 137} 138 139static int sdio_bus_remove(struct device *dev) 140{ 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 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 154 return 0; 155} 156 157static struct bus_type sdio_bus_type = { 158 .name = "sdio", 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, 164}; 165 166int sdio_register_bus(void) 167{ 168 return bus_register(&sdio_bus_type); 169} 170 171void sdio_unregister_bus(void) 172{ 173 bus_unregister(&sdio_bus_type); 174} 175 176/** 177 * sdio_register_driver - register a function driver 178 * @drv: SDIO function driver 179 */ 180int 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} 186EXPORT_SYMBOL_GPL(sdio_register_driver); 187 188/** 189 * sdio_unregister_driver - unregister a function driver 190 * @drv: SDIO function driver 191 */ 192void sdio_unregister_driver(struct sdio_driver *drv) 193{ 194 drv->drv.bus = &sdio_bus_type; 195 driver_unregister(&drv->drv); 196} 197EXPORT_SYMBOL_GPL(sdio_unregister_driver); 198 199static void sdio_release_func(struct device *dev) 200{ 201 struct sdio_func *func = dev_to_sdio_func(dev); 202 203 sdio_free_func_cis(func); 204 205 kfree(func); 206} 207 208/* 209 * Allocate and initialise a new SDIO function structure. 210 */ 211struct sdio_func *sdio_alloc_func(struct mmc_card *card) 212{ 213 struct sdio_func *func; 214 215 func = kmalloc(sizeof(struct sdio_func), GFP_KERNEL); 216 if (!func) 217 return ERR_PTR(-ENOMEM); 218 219 memset(func, 0, sizeof(struct sdio_func)); 220 221 func->card = card; 222 223 device_initialize(&func->dev); 224 225 func->dev.parent = &card->dev; 226 func->dev.bus = &sdio_bus_type; 227 func->dev.release = sdio_release_func; 228 229 return func; 230} 231 232/* 233 * Register a new SDIO function with the driver model. 234 */ 235int sdio_add_func(struct sdio_func *func) 236{ 237 int ret; 238 239 snprintf(func->dev.bus_id, sizeof(func->dev.bus_id), 240 "%s:%d", mmc_card_id(func->card), func->num); 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. 252 */ 253void sdio_remove_func(struct sdio_func *func) 254{ 255 if (sdio_func_present(func)) 256 device_del(&func->dev); 257 258 put_device(&func->dev); 259} 260 261