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#include <linux/slab.h> 17 18#include <linux/mmc/card.h> 19#include <linux/mmc/sdio_func.h> 20 21#include "sdio_cis.h" 22#include "sdio_bus.h" 23 24/* show configuration fields */ 25#define sdio_config_attr(field, format_string) \ 26static ssize_t \ 27field##_show(struct device *dev, struct device_attribute *attr, char *buf) \ 28{ \ 29 struct sdio_func *func; \ 30 \ 31 func = dev_to_sdio_func (dev); \ 32 return sprintf (buf, format_string, func->field); \ 33} 34 35sdio_config_attr(class, "0x%02x\n"); 36sdio_config_attr(vendor, "0x%04x\n"); 37sdio_config_attr(device, "0x%04x\n"); 38 39static ssize_t modalias_show(struct device *dev, struct device_attribute *attr, char *buf) 40{ 41 struct sdio_func *func = dev_to_sdio_func (dev); 42 43 return sprintf(buf, "sdio:c%02Xv%04Xd%04X\n", 44 func->class, func->vendor, func->device); 45} 46 47static struct device_attribute sdio_dev_attrs[] = { 48 __ATTR_RO(class), 49 __ATTR_RO(vendor), 50 __ATTR_RO(device), 51 __ATTR_RO(modalias), 52 __ATTR_NULL, 53}; 54 55static const struct sdio_device_id *sdio_match_one(struct sdio_func *func, 56 const struct sdio_device_id *id) 57{ 58 if (id->class != (__u8)SDIO_ANY_ID && id->class != func->class) 59 return NULL; 60 if (id->vendor != (__u16)SDIO_ANY_ID && id->vendor != func->vendor) 61 return NULL; 62 if (id->device != (__u16)SDIO_ANY_ID && id->device != func->device) 63 return NULL; 64 return id; 65} 66 67static const struct sdio_device_id *sdio_match_device(struct sdio_func *func, 68 struct sdio_driver *sdrv) 69{ 70 const struct sdio_device_id *ids; 71 72 ids = sdrv->id_table; 73 74 if (ids) { 75 while (ids->class || ids->vendor || ids->device) { 76 if (sdio_match_one(func, ids)) 77 return ids; 78 ids++; 79 } 80 } 81 82 return NULL; 83} 84 85static int sdio_bus_match(struct device *dev, struct device_driver *drv) 86{ 87 struct sdio_func *func = dev_to_sdio_func(dev); 88 struct sdio_driver *sdrv = to_sdio_driver(drv); 89 90 if (sdio_match_device(func, sdrv)) 91 return 1; 92 93 return 0; 94} 95 96static int 97sdio_bus_uevent(struct device *dev, struct kobj_uevent_env *env) 98{ 99 struct sdio_func *func = dev_to_sdio_func(dev); 100 101 if (add_uevent_var(env, 102 "SDIO_CLASS=%02X", func->class)) 103 return -ENOMEM; 104 105 if (add_uevent_var(env, 106 "SDIO_ID=%04X:%04X", func->vendor, func->device)) 107 return -ENOMEM; 108 109 if (add_uevent_var(env, 110 "MODALIAS=sdio:c%02Xv%04Xd%04X", 111 func->class, func->vendor, func->device)) 112 return -ENOMEM; 113 114 return 0; 115} 116 117static int sdio_bus_probe(struct device *dev) 118{ 119 struct sdio_driver *drv = to_sdio_driver(dev->driver); 120 struct sdio_func *func = dev_to_sdio_func(dev); 121 const struct sdio_device_id *id; 122 int ret; 123 124 id = sdio_match_device(func, drv); 125 if (!id) 126 return -ENODEV; 127 128 /* Set the default block size so the driver is sure it's something 129 * sensible. */ 130 sdio_claim_host(func); 131 ret = sdio_set_block_size(func, 0); 132 sdio_release_host(func); 133 if (ret) 134 return ret; 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 if (func->info) 206 kfree(func->info); 207 208 kfree(func); 209} 210 211/* 212 * Allocate and initialise a new SDIO function structure. 213 */ 214struct sdio_func *sdio_alloc_func(struct mmc_card *card) 215{ 216 struct sdio_func *func; 217 218 func = kzalloc(sizeof(struct sdio_func), GFP_KERNEL); 219 if (!func) 220 return ERR_PTR(-ENOMEM); 221 222 func->card = card; 223 224 device_initialize(&func->dev); 225 226 func->dev.parent = &card->dev; 227 func->dev.bus = &sdio_bus_type; 228 func->dev.release = sdio_release_func; 229 230 return func; 231} 232 233/* 234 * Register a new SDIO function with the driver model. 235 */ 236int sdio_add_func(struct sdio_func *func) 237{ 238 int ret; 239 240 dev_set_name(&func->dev, "%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 * This function can be called through error paths where sdio_add_func() was 253 * never executed (because a failure occurred at an earlier point). 254 */ 255void sdio_remove_func(struct sdio_func *func) 256{ 257 if (!sdio_func_present(func)) 258 return; 259 260 device_del(&func->dev); 261 put_device(&func->dev); 262} 263