| /* | |
| * linux/drivers/mmc/core/sysfs.c | |
| * | |
| * Copyright (C) 2003 Russell King, All Rights Reserved. | |
| * | |
| * This program is free software; you can redistribute it and/or modify | |
| * it under the terms of the GNU General Public License version 2 as | |
| * published by the Free Software Foundation. | |
| * | |
| * MMC sysfs/driver model support. | |
| */ | |
| #include <linux/module.h> | |
| #include <linux/init.h> | |
| #include <linux/device.h> | |
| #include <linux/idr.h> | |
| #include <linux/workqueue.h> | |
| #include <linux/mmc/card.h> | |
| #include <linux/mmc/host.h> | |
| #include "sysfs.h" | |
| #define dev_to_mmc_card(d) container_of(d, struct mmc_card, dev) | |
| #define to_mmc_driver(d) container_of(d, struct mmc_driver, drv) | |
| #define cls_dev_to_mmc_host(d) container_of(d, struct mmc_host, class_dev) | |
| #define MMC_ATTR(name, fmt, args...) \ | |
| static ssize_t mmc_##name##_show (struct device *dev, struct device_attribute *attr, char *buf) \ | |
| { \ | |
| struct mmc_card *card = dev_to_mmc_card(dev); \ | |
| return sprintf(buf, fmt, args); \ | |
| } | |
| MMC_ATTR(cid, "%08x%08x%08x%08x\n", card->raw_cid[0], card->raw_cid[1], | |
| card->raw_cid[2], card->raw_cid[3]); | |
| MMC_ATTR(csd, "%08x%08x%08x%08x\n", card->raw_csd[0], card->raw_csd[1], | |
| card->raw_csd[2], card->raw_csd[3]); | |
| MMC_ATTR(scr, "%08x%08x\n", card->raw_scr[0], card->raw_scr[1]); | |
| MMC_ATTR(date, "%02d/%04d\n", card->cid.month, card->cid.year); | |
| MMC_ATTR(fwrev, "0x%x\n", card->cid.fwrev); | |
| MMC_ATTR(hwrev, "0x%x\n", card->cid.hwrev); | |
| MMC_ATTR(manfid, "0x%06x\n", card->cid.manfid); | |
| MMC_ATTR(name, "%s\n", card->cid.prod_name); | |
| MMC_ATTR(oemid, "0x%04x\n", card->cid.oemid); | |
| MMC_ATTR(serial, "0x%08x\n", card->cid.serial); | |
| #define MMC_ATTR_RO(name) __ATTR(name, S_IRUGO, mmc_##name##_show, NULL) | |
| static struct device_attribute mmc_dev_attrs[] = { | |
| MMC_ATTR_RO(cid), | |
| MMC_ATTR_RO(csd), | |
| MMC_ATTR_RO(date), | |
| MMC_ATTR_RO(fwrev), | |
| MMC_ATTR_RO(hwrev), | |
| MMC_ATTR_RO(manfid), | |
| MMC_ATTR_RO(name), | |
| MMC_ATTR_RO(oemid), | |
| MMC_ATTR_RO(serial), | |
| __ATTR_NULL | |
| }; | |
| static struct device_attribute mmc_dev_attr_scr = MMC_ATTR_RO(scr); | |
| static void mmc_release_card(struct device *dev) | |
| { | |
| struct mmc_card *card = dev_to_mmc_card(dev); | |
| kfree(card); | |
| } | |
| /* | |
| * This currently matches any MMC driver to any MMC card - drivers | |
| * themselves make the decision whether to drive this card in their | |
| * probe method. | |
| */ | |
| static int mmc_bus_match(struct device *dev, struct device_driver *drv) | |
| { | |
| return 1; | |
| } | |
| static int | |
| mmc_bus_uevent(struct device *dev, char **envp, int num_envp, char *buf, | |
| int buf_size) | |
| { | |
| struct mmc_card *card = dev_to_mmc_card(dev); | |
| char ccc[13]; | |
| int retval = 0, i = 0, length = 0; | |
| #define add_env(fmt,val) do { \ | |
| retval = add_uevent_var(envp, num_envp, &i, \ | |
| buf, buf_size, &length, \ | |
| fmt, val); \ | |
| if (retval) \ | |
| return retval; \ | |
| } while (0); | |
| for (i = 0; i < 12; i++) | |
| ccc[i] = card->csd.cmdclass & (1 << i) ? '1' : '0'; | |
| ccc[12] = '\0'; | |
| add_env("MMC_CCC=%s", ccc); | |
| add_env("MMC_MANFID=%06x", card->cid.manfid); | |
| add_env("MMC_NAME=%s", mmc_card_name(card)); | |
| add_env("MMC_OEMID=%04x", card->cid.oemid); | |
| #undef add_env | |
| envp[i] = NULL; | |
| return 0; | |
| } | |
| static int mmc_bus_suspend(struct device *dev, pm_message_t state) | |
| { | |
| struct mmc_driver *drv = to_mmc_driver(dev->driver); | |
| struct mmc_card *card = dev_to_mmc_card(dev); | |
| int ret = 0; | |
| if (dev->driver && drv->suspend) | |
| ret = drv->suspend(card, state); | |
| return ret; | |
| } | |
| static int mmc_bus_resume(struct device *dev) | |
| { | |
| struct mmc_driver *drv = to_mmc_driver(dev->driver); | |
| struct mmc_card *card = dev_to_mmc_card(dev); | |
| int ret = 0; | |
| if (dev->driver && drv->resume) | |
| ret = drv->resume(card); | |
| return ret; | |
| } | |
| static int mmc_bus_probe(struct device *dev) | |
| { | |
| struct mmc_driver *drv = to_mmc_driver(dev->driver); | |
| struct mmc_card *card = dev_to_mmc_card(dev); | |
| return drv->probe(card); | |
| } | |
| static int mmc_bus_remove(struct device *dev) | |
| { | |
| struct mmc_driver *drv = to_mmc_driver(dev->driver); | |
| struct mmc_card *card = dev_to_mmc_card(dev); | |
| drv->remove(card); | |
| return 0; | |
| } | |
| static struct bus_type mmc_bus_type = { | |
| .name = "mmc", | |
| .dev_attrs = mmc_dev_attrs, | |
| .match = mmc_bus_match, | |
| .uevent = mmc_bus_uevent, | |
| .probe = mmc_bus_probe, | |
| .remove = mmc_bus_remove, | |
| .suspend = mmc_bus_suspend, | |
| .resume = mmc_bus_resume, | |
| }; | |
| /** | |
| * mmc_register_driver - register a media driver | |
| * @drv: MMC media driver | |
| */ | |
| int mmc_register_driver(struct mmc_driver *drv) | |
| { | |
| drv->drv.bus = &mmc_bus_type; | |
| return driver_register(&drv->drv); | |
| } | |
| EXPORT_SYMBOL(mmc_register_driver); | |
| /** | |
| * mmc_unregister_driver - unregister a media driver | |
| * @drv: MMC media driver | |
| */ | |
| void mmc_unregister_driver(struct mmc_driver *drv) | |
| { | |
| drv->drv.bus = &mmc_bus_type; | |
| driver_unregister(&drv->drv); | |
| } | |
| EXPORT_SYMBOL(mmc_unregister_driver); | |
| /* | |
| * Internal function. Initialise a MMC card structure. | |
| */ | |
| void mmc_init_card(struct mmc_card *card, struct mmc_host *host) | |
| { | |
| memset(card, 0, sizeof(struct mmc_card)); | |
| card->host = host; | |
| device_initialize(&card->dev); | |
| card->dev.parent = mmc_classdev(host); | |
| card->dev.bus = &mmc_bus_type; | |
| card->dev.release = mmc_release_card; | |
| } | |
| /* | |
| * Internal function. Register a new MMC card with the driver model. | |
| */ | |
| int mmc_register_card(struct mmc_card *card) | |
| { | |
| int ret; | |
| snprintf(card->dev.bus_id, sizeof(card->dev.bus_id), | |
| "%s:%04x", mmc_hostname(card->host), card->rca); | |
| ret = device_add(&card->dev); | |
| if (ret == 0) { | |
| if (mmc_card_sd(card)) { | |
| ret = device_create_file(&card->dev, &mmc_dev_attr_scr); | |
| if (ret) | |
| device_del(&card->dev); | |
| } | |
| } | |
| if (ret == 0) | |
| mmc_card_set_present(card); | |
| return ret; | |
| } | |
| /* | |
| * Internal function. Unregister a new MMC card with the | |
| * driver model, and (eventually) free it. | |
| */ | |
| void mmc_remove_card(struct mmc_card *card) | |
| { | |
| if (mmc_card_present(card)) { | |
| if (mmc_card_sd(card)) | |
| device_remove_file(&card->dev, &mmc_dev_attr_scr); | |
| device_del(&card->dev); | |
| } | |
| put_device(&card->dev); | |
| } | |
| static void mmc_host_classdev_release(struct device *dev) | |
| { | |
| struct mmc_host *host = cls_dev_to_mmc_host(dev); | |
| kfree(host); | |
| } | |
| static struct class mmc_host_class = { | |
| .name = "mmc_host", | |
| .dev_release = mmc_host_classdev_release, | |
| }; | |
| static DEFINE_IDR(mmc_host_idr); | |
| static DEFINE_SPINLOCK(mmc_host_lock); | |
| /* | |
| * Internal function. Allocate a new MMC host. | |
| */ | |
| struct mmc_host *mmc_alloc_host_sysfs(int extra, struct device *dev) | |
| { | |
| struct mmc_host *host; | |
| host = kmalloc(sizeof(struct mmc_host) + extra, GFP_KERNEL); | |
| if (host) { | |
| memset(host, 0, sizeof(struct mmc_host) + extra); | |
| host->parent = dev; | |
| host->class_dev.parent = dev; | |
| host->class_dev.class = &mmc_host_class; | |
| device_initialize(&host->class_dev); | |
| } | |
| return host; | |
| } | |
| /* | |
| * Internal function. Register a new MMC host with the MMC class. | |
| */ | |
| int mmc_add_host_sysfs(struct mmc_host *host) | |
| { | |
| int err; | |
| if (!idr_pre_get(&mmc_host_idr, GFP_KERNEL)) | |
| return -ENOMEM; | |
| spin_lock(&mmc_host_lock); | |
| err = idr_get_new(&mmc_host_idr, host, &host->index); | |
| spin_unlock(&mmc_host_lock); | |
| if (err) | |
| return err; | |
| snprintf(host->class_dev.bus_id, BUS_ID_SIZE, | |
| "mmc%d", host->index); | |
| return device_add(&host->class_dev); | |
| } | |
| /* | |
| * Internal function. Unregister a MMC host with the MMC class. | |
| */ | |
| void mmc_remove_host_sysfs(struct mmc_host *host) | |
| { | |
| device_del(&host->class_dev); | |
| spin_lock(&mmc_host_lock); | |
| idr_remove(&mmc_host_idr, host->index); | |
| spin_unlock(&mmc_host_lock); | |
| } | |
| /* | |
| * Internal function. Free a MMC host. | |
| */ | |
| void mmc_free_host_sysfs(struct mmc_host *host) | |
| { | |
| put_device(&host->class_dev); | |
| } | |
| static struct workqueue_struct *workqueue; | |
| /* | |
| * Internal function. Schedule delayed work in the MMC work queue. | |
| */ | |
| int mmc_schedule_delayed_work(struct delayed_work *work, unsigned long delay) | |
| { | |
| return queue_delayed_work(workqueue, work, delay); | |
| } | |
| /* | |
| * Internal function. Flush all scheduled work from the MMC work queue. | |
| */ | |
| void mmc_flush_scheduled_work(void) | |
| { | |
| flush_workqueue(workqueue); | |
| } | |
| static int __init mmc_init(void) | |
| { | |
| int ret; | |
| workqueue = create_singlethread_workqueue("kmmcd"); | |
| if (!workqueue) | |
| return -ENOMEM; | |
| ret = bus_register(&mmc_bus_type); | |
| if (ret == 0) { | |
| ret = class_register(&mmc_host_class); | |
| if (ret) | |
| bus_unregister(&mmc_bus_type); | |
| } | |
| return ret; | |
| } | |
| static void __exit mmc_exit(void) | |
| { | |
| class_unregister(&mmc_host_class); | |
| bus_unregister(&mmc_bus_type); | |
| destroy_workqueue(workqueue); | |
| } | |
| module_init(mmc_init); | |
| module_exit(mmc_exit); |