325 lines
7.3 KiB
C
325 lines
7.3 KiB
C
/*
|
|
* linux/drivers/mmc/mmc_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/mmc/card.h>
|
|
#include <linux/mmc/host.h>
|
|
|
|
#include "mmc.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(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 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. However, we force "bad" cards to fail.
|
|
*/
|
|
static int mmc_bus_match(struct device *dev, struct device_driver *drv)
|
|
{
|
|
struct mmc_card *card = dev_to_mmc_card(dev);
|
|
return !mmc_card_bad(card);
|
|
}
|
|
|
|
static int
|
|
mmc_bus_hotplug(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 i = 0;
|
|
|
|
#define add_env(fmt,val) \
|
|
({ \
|
|
int len, ret = -ENOMEM; \
|
|
if (i < num_envp) { \
|
|
envp[i++] = buf; \
|
|
len = snprintf(buf, buf_size, fmt, val) + 1; \
|
|
buf_size -= len; \
|
|
buf += len; \
|
|
if (buf_size >= 0) \
|
|
ret = 0; \
|
|
} \
|
|
ret; \
|
|
})
|
|
|
|
for (i = 0; i < 12; i++)
|
|
ccc[i] = card->csd.cmdclass & (1 << i) ? '1' : '0';
|
|
ccc[12] = '\0';
|
|
|
|
i = 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);
|
|
|
|
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 struct bus_type mmc_bus_type = {
|
|
.name = "mmc",
|
|
.dev_attrs = mmc_dev_attrs,
|
|
.match = mmc_bus_match,
|
|
.hotplug = mmc_bus_hotplug,
|
|
.suspend = mmc_bus_suspend,
|
|
.resume = mmc_bus_resume,
|
|
};
|
|
|
|
|
|
static int mmc_drv_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_drv_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;
|
|
}
|
|
|
|
|
|
/**
|
|
* 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;
|
|
drv->drv.probe = mmc_drv_probe;
|
|
drv->drv.remove = mmc_drv_remove;
|
|
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 = card->host->dev;
|
|
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)
|
|
{
|
|
snprintf(card->dev.bus_id, sizeof(card->dev.bus_id),
|
|
"%s:%04x", mmc_hostname(card->host), card->rca);
|
|
|
|
return device_add(&card->dev);
|
|
}
|
|
|
|
/*
|
|
* 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))
|
|
device_del(&card->dev);
|
|
|
|
put_device(&card->dev);
|
|
}
|
|
|
|
|
|
static void mmc_host_classdev_release(struct class_device *dev)
|
|
{
|
|
struct mmc_host *host = cls_dev_to_mmc_host(dev);
|
|
kfree(host);
|
|
}
|
|
|
|
static struct class mmc_host_class = {
|
|
.name = "mmc_host",
|
|
.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->dev = dev;
|
|
host->class_dev.dev = host->dev;
|
|
host->class_dev.class = &mmc_host_class;
|
|
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.class_id, BUS_ID_SIZE,
|
|
"mmc%d", host->index);
|
|
|
|
return class_device_add(&host->class_dev);
|
|
}
|
|
|
|
/*
|
|
* Internal function. Unregister a MMC host with the MMC class.
|
|
*/
|
|
void mmc_remove_host_sysfs(struct mmc_host *host)
|
|
{
|
|
class_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)
|
|
{
|
|
class_device_put(&host->class_dev);
|
|
}
|
|
|
|
|
|
static int __init mmc_init(void)
|
|
{
|
|
int 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);
|
|
}
|
|
|
|
module_init(mmc_init);
|
|
module_exit(mmc_exit);
|