forked from luck/tmp_suning_uos_patched
MMC: OMAP: Remove cover switch handling to allow adding multislot support
This patch removes the MMC cover switch handling temporarily to make following multislot patches cleaner. MMC cover switch handling will be added back in later patches after adding basic multislot support. Signed-off-by: Tony Lindgren <tony@atomide.com> Signed-off-by: Carlos Eduardo Aguiar <carlos.aguiar@indt.org.br> Signed-off-by: Pierre Ossman <drzeus@drzeus.cx>
This commit is contained in:
Tony Lindgren
Pierre Ossman
parent
d365abe27d
commit
4bc9e35556
|
|
@ -95,8 +95,6 @@
|
|||
* when the cover switch is open */
|
||||
#define OMAP_MMC_SWITCH_POLL_DELAY 500
|
||||
|
||||
static int mmc_omap_enable_poll = 1;
|
||||
|
||||
struct mmc_omap_host {
|
||||
int initialized;
|
||||
int suspended;
|
||||
|
|
@ -133,62 +131,11 @@ struct mmc_omap_host {
|
|||
short power_pin;
|
||||
short wp_pin;
|
||||
|
||||
int switch_pin;
|
||||
struct work_struct switch_work;
|
||||
struct timer_list switch_timer;
|
||||
int switch_last_state;
|
||||
};
|
||||
|
||||
static inline int
|
||||
mmc_omap_cover_is_open(struct mmc_omap_host *host)
|
||||
{
|
||||
if (host->switch_pin < 0)
|
||||
return 0;
|
||||
return omap_get_gpio_datain(host->switch_pin);
|
||||
}
|
||||
|
||||
static ssize_t
|
||||
mmc_omap_show_cover_switch(struct device *dev,
|
||||
struct device_attribute *attr, char *buf)
|
||||
{
|
||||
struct mmc_omap_host *host = dev_get_drvdata(dev);
|
||||
|
||||
return sprintf(buf, "%s\n", mmc_omap_cover_is_open(host) ? "open" :
|
||||
"closed");
|
||||
}
|
||||
|
||||
static DEVICE_ATTR(cover_switch, S_IRUGO, mmc_omap_show_cover_switch, NULL);
|
||||
|
||||
static ssize_t
|
||||
mmc_omap_show_enable_poll(struct device *dev,
|
||||
struct device_attribute *attr, char *buf)
|
||||
{
|
||||
return snprintf(buf, PAGE_SIZE, "%d\n", mmc_omap_enable_poll);
|
||||
}
|
||||
|
||||
static ssize_t
|
||||
mmc_omap_store_enable_poll(struct device *dev,
|
||||
struct device_attribute *attr, const char *buf,
|
||||
size_t size)
|
||||
{
|
||||
int enable_poll;
|
||||
|
||||
if (sscanf(buf, "%10d", &enable_poll) != 1)
|
||||
return -EINVAL;
|
||||
|
||||
if (enable_poll != mmc_omap_enable_poll) {
|
||||
struct mmc_omap_host *host = dev_get_drvdata(dev);
|
||||
|
||||
mmc_omap_enable_poll = enable_poll;
|
||||
if (enable_poll && host->switch_pin >= 0)
|
||||
schedule_work(&host->switch_work);
|
||||
}
|
||||
return size;
|
||||
}
|
||||
|
||||
static DEVICE_ATTR(enable_poll, 0664,
|
||||
mmc_omap_show_enable_poll, mmc_omap_store_enable_poll);
|
||||
|
||||
static void
|
||||
mmc_omap_start_command(struct mmc_omap_host *host, struct mmc_command *cmd)
|
||||
{
|
||||
|
|
@ -495,8 +442,7 @@ static irqreturn_t mmc_omap_irq(int irq, void *dev_id)
|
|||
if (status & OMAP_MMC_STAT_CMD_TOUT) {
|
||||
/* Timeouts are routine with some commands */
|
||||
if (host->cmd) {
|
||||
if (!mmc_omap_cover_is_open(host))
|
||||
dev_err(mmc_dev(host->mmc),
|
||||
dev_err(mmc_dev(host->mmc),
|
||||
"command timeout, CMD %d\n",
|
||||
host->cmd->opcode);
|
||||
host->cmd->error = -ETIMEDOUT;
|
||||
|
|
@ -544,54 +490,6 @@ static irqreturn_t mmc_omap_irq(int irq, void *dev_id)
|
|||
return IRQ_HANDLED;
|
||||
}
|
||||
|
||||
static irqreturn_t mmc_omap_switch_irq(int irq, void *dev_id)
|
||||
{
|
||||
struct mmc_omap_host *host = (struct mmc_omap_host *) dev_id;
|
||||
|
||||
schedule_work(&host->switch_work);
|
||||
|
||||
return IRQ_HANDLED;
|
||||
}
|
||||
|
||||
static void mmc_omap_switch_timer(unsigned long arg)
|
||||
{
|
||||
struct mmc_omap_host *host = (struct mmc_omap_host *) arg;
|
||||
|
||||
schedule_work(&host->switch_work);
|
||||
}
|
||||
|
||||
static void mmc_omap_switch_handler(struct work_struct *work)
|
||||
{
|
||||
struct mmc_omap_host *host = container_of(work, struct mmc_omap_host, switch_work);
|
||||
struct mmc_card *card;
|
||||
static int complained = 0;
|
||||
int cards = 0, cover_open;
|
||||
|
||||
if (host->switch_pin == -1)
|
||||
return;
|
||||
cover_open = mmc_omap_cover_is_open(host);
|
||||
if (cover_open != host->switch_last_state) {
|
||||
kobject_uevent(&host->dev->kobj, KOBJ_CHANGE);
|
||||
host->switch_last_state = cover_open;
|
||||
}
|
||||
mmc_detect_change(host->mmc, 0);
|
||||
list_for_each_entry(card, &host->mmc->cards, node) {
|
||||
if (mmc_card_present(card))
|
||||
cards++;
|
||||
}
|
||||
if (mmc_omap_cover_is_open(host)) {
|
||||
if (!complained) {
|
||||
dev_info(mmc_dev(host->mmc), "cover is open\n");
|
||||
complained = 1;
|
||||
}
|
||||
if (mmc_omap_enable_poll)
|
||||
mod_timer(&host->switch_timer, jiffies +
|
||||
msecs_to_jiffies(OMAP_MMC_SWITCH_POLL_DELAY));
|
||||
} else {
|
||||
complained = 0;
|
||||
}
|
||||
}
|
||||
|
||||
/* Prepare to transfer the next segment of a scatterlist */
|
||||
static void
|
||||
mmc_omap_prepare_dma(struct mmc_omap_host *host, struct mmc_data *data)
|
||||
|
|
@ -1057,7 +955,6 @@ static int __init mmc_omap_probe(struct platform_device *pdev)
|
|||
* the card detect sensing.
|
||||
*/
|
||||
host->power_pin = minfo->power_pin;
|
||||
host->switch_pin = minfo->switch_pin;
|
||||
host->wp_pin = minfo->wp_pin;
|
||||
host->use_dma = 1;
|
||||
host->dma_ch = -1;
|
||||
|
|
@ -1102,48 +999,10 @@ static int __init mmc_omap_probe(struct platform_device *pdev)
|
|||
host->dev = &pdev->dev;
|
||||
platform_set_drvdata(pdev, host);
|
||||
|
||||
if (host->switch_pin >= 0) {
|
||||
INIT_WORK(&host->switch_work, mmc_omap_switch_handler);
|
||||
init_timer(&host->switch_timer);
|
||||
host->switch_timer.function = mmc_omap_switch_timer;
|
||||
host->switch_timer.data = (unsigned long) host;
|
||||
if (omap_request_gpio(host->switch_pin) != 0) {
|
||||
dev_warn(mmc_dev(host->mmc), "Unable to get GPIO pin for MMC cover switch\n");
|
||||
host->switch_pin = -1;
|
||||
goto no_switch;
|
||||
}
|
||||
|
||||
omap_set_gpio_direction(host->switch_pin, 1);
|
||||
ret = request_irq(OMAP_GPIO_IRQ(host->switch_pin),
|
||||
mmc_omap_switch_irq, IRQF_TRIGGER_RISING, DRIVER_NAME, host);
|
||||
if (ret) {
|
||||
dev_warn(mmc_dev(host->mmc), "Unable to get IRQ for MMC cover switch\n");
|
||||
omap_free_gpio(host->switch_pin);
|
||||
host->switch_pin = -1;
|
||||
goto no_switch;
|
||||
}
|
||||
ret = device_create_file(&pdev->dev, &dev_attr_cover_switch);
|
||||
if (ret == 0) {
|
||||
ret = device_create_file(&pdev->dev, &dev_attr_enable_poll);
|
||||
if (ret != 0)
|
||||
device_remove_file(&pdev->dev, &dev_attr_cover_switch);
|
||||
}
|
||||
if (ret) {
|
||||
dev_warn(mmc_dev(host->mmc), "Unable to create sysfs attributes\n");
|
||||
free_irq(OMAP_GPIO_IRQ(host->switch_pin), host);
|
||||
omap_free_gpio(host->switch_pin);
|
||||
host->switch_pin = -1;
|
||||
goto no_switch;
|
||||
}
|
||||
if (mmc_omap_enable_poll && mmc_omap_cover_is_open(host))
|
||||
schedule_work(&host->switch_work);
|
||||
}
|
||||
|
||||
mmc_add_host(mmc);
|
||||
|
||||
return 0;
|
||||
|
||||
no_switch:
|
||||
/* FIXME: Free other resources too. */
|
||||
if (host) {
|
||||
if (host->iclk && !IS_ERR(host->iclk))
|
||||
|
|
@ -1182,15 +1041,6 @@ static int mmc_omap_remove(struct platform_device *pdev)
|
|||
|
||||
if (host->power_pin >= 0)
|
||||
omap_free_gpio(host->power_pin);
|
||||
if (host->switch_pin >= 0) {
|
||||
device_remove_file(&pdev->dev, &dev_attr_enable_poll);
|
||||
device_remove_file(&pdev->dev, &dev_attr_cover_switch);
|
||||
free_irq(OMAP_GPIO_IRQ(host->switch_pin), host);
|
||||
omap_free_gpio(host->switch_pin);
|
||||
host->switch_pin = -1;
|
||||
del_timer_sync(&host->switch_timer);
|
||||
flush_scheduled_work();
|
||||
}
|
||||
if (host->iclk && !IS_ERR(host->iclk))
|
||||
clk_put(host->iclk);
|
||||
if (host->fclk && !IS_ERR(host->fclk))
|
||||
|
|
|
|||
Loading…
Reference in New Issue
Block a user