mmc: omap_hsmmc: use slot-gpio library for gpio support.
Using the common code removes some code duplication, and makes it easier to switch to using mmc_of_parse() which will remove more duplication. This uses the new mmc_gpio_request_cd_isr to provide a non-standard interrupt service routine for card-detect interrupts. Signed-off-by: NeilBrown <neilb@suse.de> Signed-off-by: Ulf Hansson <ulf.hansson@linaro.org>
This commit is contained in:
parent
c7ea834d81
commit
41afa31419
|
@ -36,6 +36,7 @@
|
||||||
#include <linux/mmc/host.h>
|
#include <linux/mmc/host.h>
|
||||||
#include <linux/mmc/core.h>
|
#include <linux/mmc/core.h>
|
||||||
#include <linux/mmc/mmc.h>
|
#include <linux/mmc/mmc.h>
|
||||||
|
#include <linux/mmc/slot-gpio.h>
|
||||||
#include <linux/io.h>
|
#include <linux/io.h>
|
||||||
#include <linux/irq.h>
|
#include <linux/irq.h>
|
||||||
#include <linux/gpio.h>
|
#include <linux/gpio.h>
|
||||||
|
@ -251,28 +252,22 @@ static void omap_hsmmc_start_dma_transfer(struct omap_hsmmc_host *host);
|
||||||
static int omap_hsmmc_card_detect(struct device *dev)
|
static int omap_hsmmc_card_detect(struct device *dev)
|
||||||
{
|
{
|
||||||
struct omap_hsmmc_host *host = dev_get_drvdata(dev);
|
struct omap_hsmmc_host *host = dev_get_drvdata(dev);
|
||||||
struct omap_hsmmc_platform_data *mmc = host->pdata;
|
|
||||||
|
|
||||||
/* NOTE: assumes card detect signal is active-low */
|
return mmc_gpio_get_cd(host->mmc);
|
||||||
return !gpio_get_value_cansleep(mmc->switch_pin);
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static int omap_hsmmc_get_wp(struct device *dev)
|
static int omap_hsmmc_get_wp(struct device *dev)
|
||||||
{
|
{
|
||||||
struct omap_hsmmc_host *host = dev_get_drvdata(dev);
|
struct omap_hsmmc_host *host = dev_get_drvdata(dev);
|
||||||
struct omap_hsmmc_platform_data *mmc = host->pdata;
|
|
||||||
|
|
||||||
/* NOTE: assumes write protect signal is active-high */
|
return mmc_gpio_get_ro(host->mmc);
|
||||||
return gpio_get_value_cansleep(mmc->gpio_wp);
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static int omap_hsmmc_get_cover_state(struct device *dev)
|
static int omap_hsmmc_get_cover_state(struct device *dev)
|
||||||
{
|
{
|
||||||
struct omap_hsmmc_host *host = dev_get_drvdata(dev);
|
struct omap_hsmmc_host *host = dev_get_drvdata(dev);
|
||||||
struct omap_hsmmc_platform_data *mmc = host->pdata;
|
|
||||||
|
|
||||||
/* NOTE: assumes card detect signal is active-low */
|
return mmc_gpio_get_cd(host->mmc);
|
||||||
return !gpio_get_value_cansleep(mmc->switch_pin);
|
|
||||||
}
|
}
|
||||||
|
|
||||||
#ifdef CONFIG_REGULATOR
|
#ifdef CONFIG_REGULATOR
|
||||||
|
@ -439,7 +434,10 @@ static inline int omap_hsmmc_have_reg(void)
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
static int omap_hsmmc_gpio_init(struct omap_hsmmc_host *host,
|
static irqreturn_t omap_hsmmc_detect(int irq, void *dev_id);
|
||||||
|
|
||||||
|
static int omap_hsmmc_gpio_init(struct mmc_host *mmc,
|
||||||
|
struct omap_hsmmc_host *host,
|
||||||
struct omap_hsmmc_platform_data *pdata)
|
struct omap_hsmmc_platform_data *pdata)
|
||||||
{
|
{
|
||||||
int ret;
|
int ret;
|
||||||
|
@ -452,46 +450,24 @@ static int omap_hsmmc_gpio_init(struct omap_hsmmc_host *host,
|
||||||
host->card_detect = omap_hsmmc_card_detect;
|
host->card_detect = omap_hsmmc_card_detect;
|
||||||
host->card_detect_irq =
|
host->card_detect_irq =
|
||||||
gpio_to_irq(pdata->switch_pin);
|
gpio_to_irq(pdata->switch_pin);
|
||||||
ret = gpio_request(pdata->switch_pin, "mmc_cd");
|
mmc_gpio_set_cd_isr(mmc, omap_hsmmc_detect);
|
||||||
|
ret = mmc_gpio_request_cd(mmc, pdata->switch_pin, 0);
|
||||||
if (ret)
|
if (ret)
|
||||||
return ret;
|
return ret;
|
||||||
ret = gpio_direction_input(pdata->switch_pin);
|
|
||||||
if (ret)
|
|
||||||
goto err_free_sp;
|
|
||||||
} else {
|
} else {
|
||||||
pdata->switch_pin = -EINVAL;
|
pdata->switch_pin = -EINVAL;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (gpio_is_valid(pdata->gpio_wp)) {
|
if (gpio_is_valid(pdata->gpio_wp)) {
|
||||||
host->get_ro = omap_hsmmc_get_wp;
|
host->get_ro = omap_hsmmc_get_wp;
|
||||||
ret = gpio_request(pdata->gpio_wp, "mmc_wp");
|
ret = mmc_gpio_request_ro(mmc, pdata->gpio_wp);
|
||||||
if (ret)
|
if (ret)
|
||||||
goto err_free_cd;
|
return ret;
|
||||||
ret = gpio_direction_input(pdata->gpio_wp);
|
|
||||||
if (ret)
|
|
||||||
goto err_free_wp;
|
|
||||||
} else {
|
} else {
|
||||||
pdata->gpio_wp = -EINVAL;
|
pdata->gpio_wp = -EINVAL;
|
||||||
}
|
}
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
err_free_wp:
|
|
||||||
gpio_free(pdata->gpio_wp);
|
|
||||||
err_free_cd:
|
|
||||||
if (gpio_is_valid(pdata->switch_pin))
|
|
||||||
err_free_sp:
|
|
||||||
gpio_free(pdata->switch_pin);
|
|
||||||
return ret;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void omap_hsmmc_gpio_free(struct omap_hsmmc_host *host,
|
|
||||||
struct omap_hsmmc_platform_data *pdata)
|
|
||||||
{
|
|
||||||
if (gpio_is_valid(pdata->gpio_wp))
|
|
||||||
gpio_free(pdata->gpio_wp);
|
|
||||||
if (gpio_is_valid(pdata->switch_pin))
|
|
||||||
gpio_free(pdata->switch_pin);
|
|
||||||
}
|
}
|
||||||
|
|
||||||
/*
|
/*
|
||||||
|
@ -2066,7 +2042,7 @@ static int omap_hsmmc_probe(struct platform_device *pdev)
|
||||||
host->next_data.cookie = 1;
|
host->next_data.cookie = 1;
|
||||||
host->pbias_enabled = 0;
|
host->pbias_enabled = 0;
|
||||||
|
|
||||||
ret = omap_hsmmc_gpio_init(host, pdata);
|
ret = omap_hsmmc_gpio_init(mmc, host, pdata);
|
||||||
if (ret)
|
if (ret)
|
||||||
goto err_gpio;
|
goto err_gpio;
|
||||||
|
|
||||||
|
@ -2197,20 +2173,6 @@ static int omap_hsmmc_probe(struct platform_device *pdev)
|
||||||
|
|
||||||
mmc->ocr_avail = mmc_pdata(host)->ocr_mask;
|
mmc->ocr_avail = mmc_pdata(host)->ocr_mask;
|
||||||
|
|
||||||
/* Request IRQ for card detect */
|
|
||||||
if (host->card_detect_irq) {
|
|
||||||
ret = devm_request_threaded_irq(&pdev->dev,
|
|
||||||
host->card_detect_irq,
|
|
||||||
NULL, omap_hsmmc_detect,
|
|
||||||
IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING | IRQF_ONESHOT,
|
|
||||||
mmc_hostname(mmc), host);
|
|
||||||
if (ret) {
|
|
||||||
dev_err(mmc_dev(host->mmc),
|
|
||||||
"Unable to grab MMC CD IRQ\n");
|
|
||||||
goto err_irq_cd;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
omap_hsmmc_disable_irq(host);
|
omap_hsmmc_disable_irq(host);
|
||||||
|
|
||||||
/*
|
/*
|
||||||
|
@ -2249,7 +2211,6 @@ static int omap_hsmmc_probe(struct platform_device *pdev)
|
||||||
|
|
||||||
err_slot_name:
|
err_slot_name:
|
||||||
mmc_remove_host(mmc);
|
mmc_remove_host(mmc);
|
||||||
err_irq_cd:
|
|
||||||
if (host->use_reg)
|
if (host->use_reg)
|
||||||
omap_hsmmc_reg_put(host);
|
omap_hsmmc_reg_put(host);
|
||||||
err_irq:
|
err_irq:
|
||||||
|
@ -2262,7 +2223,6 @@ err_irq:
|
||||||
if (host->dbclk)
|
if (host->dbclk)
|
||||||
clk_disable_unprepare(host->dbclk);
|
clk_disable_unprepare(host->dbclk);
|
||||||
err1:
|
err1:
|
||||||
omap_hsmmc_gpio_free(host, pdata);
|
|
||||||
err_gpio:
|
err_gpio:
|
||||||
mmc_free_host(mmc);
|
mmc_free_host(mmc);
|
||||||
err:
|
err:
|
||||||
|
@ -2288,7 +2248,6 @@ static int omap_hsmmc_remove(struct platform_device *pdev)
|
||||||
if (host->dbclk)
|
if (host->dbclk)
|
||||||
clk_disable_unprepare(host->dbclk);
|
clk_disable_unprepare(host->dbclk);
|
||||||
|
|
||||||
omap_hsmmc_gpio_free(host, host->pdata);
|
|
||||||
mmc_free_host(host->mmc);
|
mmc_free_host(host->mmc);
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
|
|
Loading…
Reference in New Issue