|
@@ -21,28 +21,17 @@
|
|
|
|
|
|
#include <linux/clk.h>
|
|
#include <linux/clk.h>
|
|
#include <linux/err.h>
|
|
#include <linux/err.h>
|
|
-#include <linux/gpio.h>
|
|
|
|
#include <linux/io.h>
|
|
#include <linux/io.h>
|
|
#include <linux/mmc/host.h>
|
|
#include <linux/mmc/host.h>
|
|
#include <linux/module.h>
|
|
#include <linux/module.h>
|
|
#include <linux/of.h>
|
|
#include <linux/of.h>
|
|
-#include <linux/of_gpio.h>
|
|
|
|
|
|
|
|
#include "sdhci-pltfm.h"
|
|
#include "sdhci-pltfm.h"
|
|
|
|
|
|
struct sdhci_dove_priv {
|
|
struct sdhci_dove_priv {
|
|
struct clk *clk;
|
|
struct clk *clk;
|
|
- int gpio_cd;
|
|
|
|
};
|
|
};
|
|
|
|
|
|
-static irqreturn_t sdhci_dove_carddetect_irq(int irq, void *data)
|
|
|
|
-{
|
|
|
|
- struct sdhci_host *host = data;
|
|
|
|
-
|
|
|
|
- tasklet_schedule(&host->card_tasklet);
|
|
|
|
- return IRQ_HANDLED;
|
|
|
|
-}
|
|
|
|
-
|
|
|
|
static u16 sdhci_dove_readw(struct sdhci_host *host, int reg)
|
|
static u16 sdhci_dove_readw(struct sdhci_host *host, int reg)
|
|
{
|
|
{
|
|
u16 ret;
|
|
u16 ret;
|
|
@@ -60,8 +49,6 @@ static u16 sdhci_dove_readw(struct sdhci_host *host, int reg)
|
|
|
|
|
|
static u32 sdhci_dove_readl(struct sdhci_host *host, int reg)
|
|
static u32 sdhci_dove_readl(struct sdhci_host *host, int reg)
|
|
{
|
|
{
|
|
- struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);
|
|
|
|
- struct sdhci_dove_priv *priv = pltfm_host->priv;
|
|
|
|
u32 ret;
|
|
u32 ret;
|
|
|
|
|
|
ret = readl(host->ioaddr + reg);
|
|
ret = readl(host->ioaddr + reg);
|
|
@@ -71,14 +58,6 @@ static u32 sdhci_dove_readl(struct sdhci_host *host, int reg)
|
|
/* Mask the support for 3.0V */
|
|
/* Mask the support for 3.0V */
|
|
ret &= ~SDHCI_CAN_VDD_300;
|
|
ret &= ~SDHCI_CAN_VDD_300;
|
|
break;
|
|
break;
|
|
- case SDHCI_PRESENT_STATE:
|
|
|
|
- if (gpio_is_valid(priv->gpio_cd)) {
|
|
|
|
- if (gpio_get_value(priv->gpio_cd) == 0)
|
|
|
|
- ret |= SDHCI_CARD_PRESENT;
|
|
|
|
- else
|
|
|
|
- ret &= ~SDHCI_CARD_PRESENT;
|
|
|
|
- }
|
|
|
|
- break;
|
|
|
|
}
|
|
}
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
@@ -117,28 +96,9 @@ static int sdhci_dove_probe(struct platform_device *pdev)
|
|
|
|
|
|
priv->clk = devm_clk_get(&pdev->dev, NULL);
|
|
priv->clk = devm_clk_get(&pdev->dev, NULL);
|
|
|
|
|
|
- if (pdev->dev.of_node) {
|
|
|
|
- priv->gpio_cd = of_get_named_gpio(pdev->dev.of_node,
|
|
|
|
- "cd-gpios", 0);
|
|
|
|
- } else {
|
|
|
|
- priv->gpio_cd = -EINVAL;
|
|
|
|
- }
|
|
|
|
-
|
|
|
|
- if (gpio_is_valid(priv->gpio_cd)) {
|
|
|
|
- ret = gpio_request(priv->gpio_cd, "sdhci-cd");
|
|
|
|
- if (ret) {
|
|
|
|
- dev_err(&pdev->dev, "card detect gpio request failed: %d\n",
|
|
|
|
- ret);
|
|
|
|
- return ret;
|
|
|
|
- }
|
|
|
|
- gpio_direction_input(priv->gpio_cd);
|
|
|
|
- }
|
|
|
|
-
|
|
|
|
host = sdhci_pltfm_init(pdev, &sdhci_dove_pdata, 0);
|
|
host = sdhci_pltfm_init(pdev, &sdhci_dove_pdata, 0);
|
|
- if (IS_ERR(host)) {
|
|
|
|
- ret = PTR_ERR(host);
|
|
|
|
- goto err_sdhci_pltfm_init;
|
|
|
|
- }
|
|
|
|
|
|
+ if (IS_ERR(host))
|
|
|
|
+ return PTR_ERR(host);
|
|
|
|
|
|
pltfm_host = sdhci_priv(host);
|
|
pltfm_host = sdhci_priv(host);
|
|
pltfm_host->priv = priv;
|
|
pltfm_host->priv = priv;
|
|
@@ -146,39 +106,20 @@ static int sdhci_dove_probe(struct platform_device *pdev)
|
|
if (!IS_ERR(priv->clk))
|
|
if (!IS_ERR(priv->clk))
|
|
clk_prepare_enable(priv->clk);
|
|
clk_prepare_enable(priv->clk);
|
|
|
|
|
|
- sdhci_get_of_property(pdev);
|
|
|
|
|
|
+ ret = mmc_of_parse(host->mmc);
|
|
|
|
+ if (ret)
|
|
|
|
+ goto err_sdhci_add;
|
|
|
|
|
|
ret = sdhci_add_host(host);
|
|
ret = sdhci_add_host(host);
|
|
if (ret)
|
|
if (ret)
|
|
goto err_sdhci_add;
|
|
goto err_sdhci_add;
|
|
|
|
|
|
- /*
|
|
|
|
- * We must request the IRQ after sdhci_add_host(), as the tasklet only
|
|
|
|
- * gets setup in sdhci_add_host() and we oops.
|
|
|
|
- */
|
|
|
|
- if (gpio_is_valid(priv->gpio_cd)) {
|
|
|
|
- ret = request_irq(gpio_to_irq(priv->gpio_cd),
|
|
|
|
- sdhci_dove_carddetect_irq,
|
|
|
|
- IRQF_TRIGGER_FALLING | IRQF_TRIGGER_RISING,
|
|
|
|
- mmc_hostname(host->mmc), host);
|
|
|
|
- if (ret) {
|
|
|
|
- dev_err(&pdev->dev, "card detect irq request failed: %d\n",
|
|
|
|
- ret);
|
|
|
|
- goto err_request_irq;
|
|
|
|
- }
|
|
|
|
- }
|
|
|
|
-
|
|
|
|
return 0;
|
|
return 0;
|
|
|
|
|
|
-err_request_irq:
|
|
|
|
- sdhci_remove_host(host, 0);
|
|
|
|
err_sdhci_add:
|
|
err_sdhci_add:
|
|
if (!IS_ERR(priv->clk))
|
|
if (!IS_ERR(priv->clk))
|
|
clk_disable_unprepare(priv->clk);
|
|
clk_disable_unprepare(priv->clk);
|
|
sdhci_pltfm_free(pdev);
|
|
sdhci_pltfm_free(pdev);
|
|
-err_sdhci_pltfm_init:
|
|
|
|
- if (gpio_is_valid(priv->gpio_cd))
|
|
|
|
- gpio_free(priv->gpio_cd);
|
|
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
|
|
@@ -190,11 +131,6 @@ static int sdhci_dove_remove(struct platform_device *pdev)
|
|
|
|
|
|
sdhci_pltfm_unregister(pdev);
|
|
sdhci_pltfm_unregister(pdev);
|
|
|
|
|
|
- if (gpio_is_valid(priv->gpio_cd)) {
|
|
|
|
- free_irq(gpio_to_irq(priv->gpio_cd), host);
|
|
|
|
- gpio_free(priv->gpio_cd);
|
|
|
|
- }
|
|
|
|
-
|
|
|
|
if (!IS_ERR(priv->clk))
|
|
if (!IS_ERR(priv->clk))
|
|
clk_disable_unprepare(priv->clk);
|
|
clk_disable_unprepare(priv->clk);
|
|
|
|
|