sdio_bus.c revision 9a08f82b3cc522f727ace580a2aaee5402435bc8
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 int ret; 132 133 id = sdio_match_device(func, drv); 134 if (!id) 135 return -ENODEV; 136 137 /* Set the default block size so the driver is sure it's something 138 * sensible. */ 139 sdio_claim_host(func); 140 ret = sdio_set_block_size(func, 0); 141 sdio_release_host(func); 142 if (ret) 143 return ret; 144 145 return drv->probe(func, id); 146} 147 148static int sdio_bus_remove(struct device *dev) 149{ 150 struct sdio_driver *drv = to_sdio_driver(dev->driver); 151 struct sdio_func *func = dev_to_sdio_func(dev); 152 153 drv->remove(func); 154 155 if (func->irq_handler) { 156 printk(KERN_WARNING "WARNING: driver %s did not remove " 157 "its interrupt handler!\n", drv->name); 158 sdio_claim_host(func); 159 sdio_release_irq(func); 160 sdio_release_host(func); 161 } 162 163 return 0; 164} 165 166static struct bus_type sdio_bus_type = { 167 .name = "sdio", 168 .dev_attrs = sdio_dev_attrs, 169 .match = sdio_bus_match, 170 .uevent = sdio_bus_uevent, 171 .probe = sdio_bus_probe, 172 .remove = sdio_bus_remove, 173}; 174 175int sdio_register_bus(void) 176{ 177 return bus_register(&sdio_bus_type); 178} 179 180void sdio_unregister_bus(void) 181{ 182 bus_unregister(&sdio_bus_type); 183} 184 185/** 186 * sdio_register_driver - register a function driver 187 * @drv: SDIO function driver 188 */ 189int sdio_register_driver(struct sdio_driver *drv) 190{ 191 drv->drv.name = drv->name; 192 drv->drv.bus = &sdio_bus_type; 193 return driver_register(&drv->drv); 194} 195EXPORT_SYMBOL_GPL(sdio_register_driver); 196 197/** 198 * sdio_unregister_driver - unregister a function driver 199 * @drv: SDIO function driver 200 */ 201void sdio_unregister_driver(struct sdio_driver *drv) 202{ 203 drv->drv.bus = &sdio_bus_type; 204 driver_unregister(&drv->drv); 205} 206EXPORT_SYMBOL_GPL(sdio_unregister_driver); 207 208static void sdio_release_func(struct device *dev) 209{ 210 struct sdio_func *func = dev_to_sdio_func(dev); 211 212 sdio_free_func_cis(func); 213 214 kfree(func); 215} 216 217/* 218 * Allocate and initialise a new SDIO function structure. 219 */ 220struct sdio_func *sdio_alloc_func(struct mmc_card *card) 221{ 222 struct sdio_func *func; 223 224 func = kmalloc(sizeof(struct sdio_func), GFP_KERNEL); 225 if (!func) 226 return ERR_PTR(-ENOMEM); 227 228 memset(func, 0, sizeof(struct sdio_func)); 229 230 func->card = card; 231 232 device_initialize(&func->dev); 233 234 func->dev.parent = &card->dev; 235 func->dev.bus = &sdio_bus_type; 236 func->dev.release = sdio_release_func; 237 238 return func; 239} 240 241/* 242 * Register a new SDIO function with the driver model. 243 */ 244int sdio_add_func(struct sdio_func *func) 245{ 246 int ret; 247 248 snprintf(func->dev.bus_id, sizeof(func->dev.bus_id), 249 "%s:%d", mmc_card_id(func->card), func->num); 250 251 ret = device_add(&func->dev); 252 if (ret == 0) 253 sdio_func_set_present(func); 254 255 return ret; 256} 257 258/* 259 * Unregister a SDIO function with the driver model, and 260 * (eventually) free it. 261 */ 262void sdio_remove_func(struct sdio_func *func) 263{ 264 if (sdio_func_present(func)) 265 device_del(&func->dev); 266 267 put_device(&func->dev); 268} 269 270