mmc: host: s3cmci: allow probing from device tree
authorSergio Prado <sergio.prado@e-labworks.com>
Fri, 31 Mar 2017 23:50:56 +0000 (20:50 -0300)
committerUlf Hansson <ulf.hansson@linaro.org>
Mon, 24 Apr 2017 19:41:59 +0000 (21:41 +0200)
Allows configuring Samsung S3C24XX MMC/SD/SDIO controller using a device
tree.

Signed-off-by: Sergio Prado <sergio.prado@e-labworks.com>
[Arnd: fix broken conditional expression]
Signed-off-by: Arnd Bergmann <arnd@arndb.de>
Signed-off-by: Ulf Hansson <ulf.hansson@linaro.org>
drivers/mmc/host/s3cmci.c

index 5c9037ebc44ebdb0c720d409da3b28665430fca5..8896bf533dc7b9c6ea17e39eed64b302d058c326 100644 (file)
 #include <linux/interrupt.h>
 #include <linux/irq.h>
 #include <linux/io.h>
+#include <linux/of.h>
+#include <linux/of_device.h>
+#include <linux/of_gpio.h>
+#include <linux/mmc/slot-gpio.h>
 
 #include <plat/gpio-cfg.h>
 #include <mach/dma.h>
@@ -807,21 +811,6 @@ irq_out:
 
 }
 
-/*
- * ISR for the CardDetect Pin
-*/
-
-static irqreturn_t s3cmci_irq_cd(int irq, void *dev_id)
-{
-       struct s3cmci_host *host = (struct s3cmci_host *)dev_id;
-
-       dbg(host, dbg_irq, "card detect\n");
-
-       mmc_detect_change(host->mmc, msecs_to_jiffies(500));
-
-       return IRQ_HANDLED;
-}
-
 static void s3cmci_dma_done_callback(void *arg)
 {
        struct s3cmci_host *host = arg;
@@ -1177,19 +1166,6 @@ static void s3cmci_send_request(struct mmc_host *mmc)
        s3cmci_enable_irq(host, true);
 }
 
-static int s3cmci_card_present(struct mmc_host *mmc)
-{
-       struct s3cmci_host *host = mmc_priv(mmc);
-       struct s3c24xx_mci_pdata *pdata = host->pdata;
-       int ret;
-
-       if (pdata->no_detect)
-               return -ENOSYS;
-
-       ret = gpio_get_value(pdata->gpio_detect) ? 0 : 1;
-       return ret ^ pdata->detect_invert;
-}
-
 static void s3cmci_request(struct mmc_host *mmc, struct mmc_request *mrq)
 {
        struct s3cmci_host *host = mmc_priv(mmc);
@@ -1198,7 +1174,7 @@ static void s3cmci_request(struct mmc_host *mmc, struct mmc_request *mrq)
        host->cmd_is_stop = 0;
        host->mrq = mrq;
 
-       if (s3cmci_card_present(mmc) == 0) {
+       if (mmc_gpio_get_cd(mmc) == 0) {
                dbg(host, dbg_err, "%s: no medium present\n", __func__);
                host->mrq->cmd->error = -ENOMEDIUM;
                mmc_request_done(mmc, mrq);
@@ -1242,8 +1218,9 @@ static void s3cmci_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
        case MMC_POWER_ON:
        case MMC_POWER_UP:
                /* Configure GPE5...GPE10 pins in SD mode */
-               s3c_gpio_cfgall_range(S3C2410_GPE(5), 6, S3C_GPIO_SFN(2),
-                                     S3C_GPIO_PULL_NONE);
+               if (!host->pdev->dev.of_node)
+                       s3c_gpio_cfgall_range(S3C2410_GPE(5), 6, S3C_GPIO_SFN(2),
+                                             S3C_GPIO_PULL_NONE);
 
                if (host->pdata->set_power)
                        host->pdata->set_power(ios->power_mode, ios->vdd);
@@ -1255,7 +1232,8 @@ static void s3cmci_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
 
        case MMC_POWER_OFF:
        default:
-               gpio_direction_output(S3C2410_GPE(5), 0);
+               if (!host->pdev->dev.of_node)
+                       gpio_direction_output(S3C2410_GPE(5), 0);
 
                if (host->is2440)
                        mci_con |= S3C2440_SDICON_SDRESET;
@@ -1295,21 +1273,6 @@ static void s3cmci_reset(struct s3cmci_host *host)
        writel(con, host->base + S3C2410_SDICON);
 }
 
-static int s3cmci_get_ro(struct mmc_host *mmc)
-{
-       struct s3cmci_host *host = mmc_priv(mmc);
-       struct s3c24xx_mci_pdata *pdata = host->pdata;
-       int ret;
-
-       if (pdata->no_wprotect)
-               return 0;
-
-       ret = gpio_get_value(pdata->gpio_wprotect) ? 1 : 0;
-       ret ^= pdata->wprotect_invert;
-
-       return ret;
-}
-
 static void s3cmci_enable_sdio_irq(struct mmc_host *mmc, int enable)
 {
        struct s3cmci_host *host = mmc_priv(mmc);
@@ -1353,8 +1316,8 @@ static void s3cmci_enable_sdio_irq(struct mmc_host *mmc, int enable)
 static struct mmc_host_ops s3cmci_ops = {
        .request        = s3cmci_request,
        .set_ios        = s3cmci_set_ios,
-       .get_ro         = s3cmci_get_ro,
-       .get_cd         = s3cmci_card_present,
+       .get_ro         = mmc_gpio_get_ro,
+       .get_cd         = mmc_gpio_get_cd,
        .enable_sdio_irq = s3cmci_enable_sdio_irq,
 };
 
@@ -1545,21 +1508,14 @@ static inline void s3cmci_debugfs_remove(struct s3cmci_host *host) { }
 
 #endif /* CONFIG_DEBUG_FS */
 
-static int s3cmci_probe(struct platform_device *pdev)
+static int s3cmci_probe_pdata(struct s3cmci_host *host)
 {
-       struct s3cmci_host *host;
-       struct mmc_host *mmc;
-       int ret;
-       int is2440;
-       int i;
+       struct platform_device *pdev = host->pdev;
+       struct mmc_host *mmc = host->mmc;
+       struct s3c24xx_mci_pdata *pdata;
+       int i, ret;
 
-       is2440 = platform_get_device_id(pdev)->driver_data;
-
-       mmc = mmc_alloc_host(sizeof(struct s3cmci_host), &pdev->dev);
-       if (!mmc) {
-               ret = -ENOMEM;
-               goto probe_out;
-       }
+       host->is2440 = platform_get_device_id(pdev)->driver_data;
 
        for (i = S3C2410_GPE(5); i <= S3C2410_GPE(10); i++) {
                ret = gpio_request(i, dev_name(&pdev->dev));
@@ -1569,25 +1525,101 @@ static int s3cmci_probe(struct platform_device *pdev)
                        for (i--; i >= S3C2410_GPE(5); i--)
                                gpio_free(i);
 
-                       goto probe_free_host;
+                       return ret;
+               }
+       }
+
+       if (!pdev->dev.platform_data)
+               pdev->dev.platform_data = &s3cmci_def_pdata;
+
+       pdata = pdev->dev.platform_data;
+
+       if (pdata->no_wprotect)
+               mmc->caps2 |= MMC_CAP2_NO_WRITE_PROTECT;
+
+       if (pdata->no_detect)
+               mmc->caps |= MMC_CAP_NEEDS_POLL;
+
+       if (pdata->wprotect_invert)
+               mmc->caps2 |= MMC_CAP2_RO_ACTIVE_HIGH;
+
+       if (pdata->detect_invert)
+                mmc->caps2 |= MMC_CAP2_CD_ACTIVE_HIGH;
+
+       if (gpio_is_valid(pdata->gpio_detect)) {
+               ret = mmc_gpio_request_cd(mmc, pdata->gpio_detect, 0);
+               if (ret) {
+                       dev_err(&pdev->dev, "error requesting GPIO for CD %d\n",
+                               ret);
+                       return ret;
                }
        }
 
+       if (gpio_is_valid(pdata->gpio_wprotect)) {
+               ret = mmc_gpio_request_ro(mmc, pdata->gpio_wprotect);
+               if (ret) {
+                       dev_err(&pdev->dev, "error requesting GPIO for WP %d\n",
+                               ret);
+                       return ret;
+               }
+       }
+
+       return 0;
+}
+
+static int s3cmci_probe_dt(struct s3cmci_host *host)
+{
+       struct platform_device *pdev = host->pdev;
+       struct s3c24xx_mci_pdata *pdata;
+       struct mmc_host *mmc = host->mmc;
+       int ret;
+
+       host->is2440 = (int) of_device_get_match_data(&pdev->dev);
+
+       ret = mmc_of_parse(mmc);
+       if (ret)
+               return ret;
+
+       pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL);
+       if (!pdata)
+               return -ENOMEM;
+
+       pdev->dev.platform_data = pdata;
+
+       return 0;
+}
+
+static int s3cmci_probe(struct platform_device *pdev)
+{
+       struct s3cmci_host *host;
+       struct mmc_host *mmc;
+       int ret;
+       int i;
+
+       mmc = mmc_alloc_host(sizeof(struct s3cmci_host), &pdev->dev);
+       if (!mmc) {
+               ret = -ENOMEM;
+               goto probe_out;
+       }
+
        host = mmc_priv(mmc);
        host->mmc       = mmc;
        host->pdev      = pdev;
-       host->is2440    = is2440;
+
+       if (pdev->dev.of_node)
+               ret = s3cmci_probe_dt(host);
+       else
+               ret = s3cmci_probe_pdata(host);
+
+       if (ret)
+               goto probe_free_host;
 
        host->pdata = pdev->dev.platform_data;
-       if (!host->pdata) {
-               pdev->dev.platform_data = &s3cmci_def_pdata;
-               host->pdata = &s3cmci_def_pdata;
-       }
 
        spin_lock_init(&host->complete_lock);
        tasklet_init(&host->pio_tasklet, pio_tasklet, (unsigned long) host);
 
-       if (is2440) {
+       if (host->is2440) {
                host->sdiimsk   = S3C2440_SDIIMSK;
                host->sdidata   = S3C2440_SDIDATA;
                host->clk_div   = 1;
@@ -1645,43 +1677,6 @@ static int s3cmci_probe(struct platform_device *pdev)
        disable_irq(host->irq);
        host->irq_state = false;
 
-       if (!host->pdata->no_detect) {
-               ret = gpio_request(host->pdata->gpio_detect, "s3cmci detect");
-               if (ret) {
-                       dev_err(&pdev->dev, "failed to get detect gpio\n");
-                       goto probe_free_irq;
-               }
-
-               host->irq_cd = gpio_to_irq(host->pdata->gpio_detect);
-
-               if (host->irq_cd >= 0) {
-                       if (request_irq(host->irq_cd, s3cmci_irq_cd,
-                                       IRQF_TRIGGER_RISING |
-                                       IRQF_TRIGGER_FALLING,
-                                       DRIVER_NAME, host)) {
-                               dev_err(&pdev->dev,
-                                       "can't get card detect irq.\n");
-                               ret = -ENOENT;
-                               goto probe_free_gpio_cd;
-                       }
-               } else {
-                       dev_warn(&pdev->dev,
-                                "host detect has no irq available\n");
-                       gpio_direction_input(host->pdata->gpio_detect);
-               }
-       } else
-               host->irq_cd = -1;
-
-       if (!host->pdata->no_wprotect) {
-               ret = gpio_request(host->pdata->gpio_wprotect, "s3cmci wp");
-               if (ret) {
-                       dev_err(&pdev->dev, "failed to get writeprotect\n");
-                       goto probe_free_irq_cd;
-               }
-
-               gpio_direction_input(host->pdata->gpio_wprotect);
-       }
-
        /* Depending on the dma state, get a DMA channel to use. */
 
        if (s3cmci_host_usedma(host)) {
@@ -1689,7 +1684,7 @@ static int s3cmci_probe(struct platform_device *pdev)
                ret = PTR_ERR_OR_ZERO(host->dma);
                if (ret) {
                        dev_err(&pdev->dev, "cannot get DMA channel.\n");
-                       goto probe_free_gpio_wp;
+                       goto probe_free_irq;
                }
        }
 
@@ -1768,18 +1763,6 @@ static int s3cmci_probe(struct platform_device *pdev)
        if (s3cmci_host_usedma(host))
                dma_release_channel(host->dma);
 
- probe_free_gpio_wp:
-       if (!host->pdata->no_wprotect)
-               gpio_free(host->pdata->gpio_wprotect);
-
- probe_free_gpio_cd:
-       if (!host->pdata->no_detect)
-               gpio_free(host->pdata->gpio_detect);
-
- probe_free_irq_cd:
-       if (host->irq_cd >= 0)
-               free_irq(host->irq_cd, host);
-
  probe_free_irq:
        free_irq(host->irq, host);
 
@@ -1790,8 +1773,9 @@ static int s3cmci_probe(struct platform_device *pdev)
        release_mem_region(host->mem->start, resource_size(host->mem));
 
  probe_free_gpio:
-       for (i = S3C2410_GPE(5); i <= S3C2410_GPE(10); i++)
-               gpio_free(i);
+       if (!pdev->dev.of_node)
+               for (i = S3C2410_GPE(5); i <= S3C2410_GPE(10); i++)
+                       gpio_free(i);
 
  probe_free_host:
        mmc_free_host(mmc);
@@ -1818,7 +1802,6 @@ static int s3cmci_remove(struct platform_device *pdev)
 {
        struct mmc_host         *mmc  = platform_get_drvdata(pdev);
        struct s3cmci_host      *host = mmc_priv(mmc);
-       struct s3c24xx_mci_pdata *pd = host->pdata;
        int i;
 
        s3cmci_shutdown(pdev);
@@ -1832,15 +1815,9 @@ static int s3cmci_remove(struct platform_device *pdev)
 
        free_irq(host->irq, host);
 
-       if (!pd->no_wprotect)
-               gpio_free(pd->gpio_wprotect);
-
-       if (!pd->no_detect)
-               gpio_free(pd->gpio_detect);
-
-       for (i = S3C2410_GPE(5); i <= S3C2410_GPE(10); i++)
-               gpio_free(i);
-
+       if (!pdev->dev.of_node)
+               for (i = S3C2410_GPE(5); i <= S3C2410_GPE(10); i++)
+                       gpio_free(i);
 
        iounmap(host->base);
        release_mem_region(host->mem->start, resource_size(host->mem));
@@ -1849,6 +1826,23 @@ static int s3cmci_remove(struct platform_device *pdev)
        return 0;
 }
 
+static const struct of_device_id s3cmci_dt_match[] = {
+       {
+               .compatible = "samsung,s3c2410-sdi",
+               .data = (void *)0,
+       },
+       {
+               .compatible = "samsung,s3c2412-sdi",
+               .data = (void *)1,
+       },
+       {
+               .compatible = "samsung,s3c2440-sdi",
+               .data = (void *)1,
+       },
+       { /* sentinel */ },
+};
+MODULE_DEVICE_TABLE(of, s3cmci_dt_match);
+
 static const struct platform_device_id s3cmci_driver_ids[] = {
        {
                .name   = "s3c2410-sdi",
@@ -1868,6 +1862,7 @@ MODULE_DEVICE_TABLE(platform, s3cmci_driver_ids);
 static struct platform_driver s3cmci_driver = {
        .driver = {
                .name   = "s3c-sdi",
+               .of_match_table = s3cmci_dt_match,
        },
        .id_table       = s3cmci_driver_ids,
        .probe          = s3cmci_probe,