drivers/mmc/core/pwrseq.c

   1 /*
   2  *  Copyright (C) 2014 Linaro Ltd
   3  *
   4  * Author: Ulf Hansson <ulf.hansson@linaro.org>
   5  *
   6  * License terms: GNU General Public License (GPL) version 2
   7  *
   8  *  MMC power sequence management
   9  */
  10 #include <linux/kernel.h>
  11 #include <linux/platform_device.h>
  12 #include <linux/err.h>
  13 #include <linux/of.h>
  14 #include <linux/of_platform.h>
  15
  16 #include <linux/mmc/host.h>
  17
  18 #include "pwrseq.h"
  19
  20 struct mmc_pwrseq_match {
  21         const char *compatible;
  22         int (*alloc)(struct mmc_host *host, struct device *dev);
  23 };
  24
  25 static struct mmc_pwrseq_match pwrseq_match[] = {
  26         {
  27                 .compatible = "mmc-pwrseq-simple",
  28                 .alloc = mmc_pwrseq_simple_alloc,
  29         }, {
  30                 .compatible = "mmc-pwrseq-emmc",
  31                 .alloc = mmc_pwrseq_emmc_alloc,
  32         },
  33 };
  34
  35 static struct mmc_pwrseq_match *mmc_pwrseq_find(struct device_node *np)
  36 {
  37         struct mmc_pwrseq_match *match = ERR_PTR(-ENODEV);
  38         int i;
  39
  40         for (i = 0; i < ARRAY_SIZE(pwrseq_match); i++) {
  41                 if (of_device_is_compatible(np, pwrseq_match[i].compatible)) {
  42                         match = &pwrseq_match[i];
  43                         break;
  44                 }
  45         }
  46
  47         return match;
  48 }
  49
  50 int mmc_pwrseq_alloc(struct mmc_host *host)
  51 {
  52         struct platform_device *pdev;
  53         struct device_node *np;
  54         struct mmc_pwrseq_match *match;
  55         int ret = 0;
  56
  57         np = of_parse_phandle(host->parent->of_node, "mmc-pwrseq", 0);
  58         if (!np)
  59                 return 0;
  60
  61         pdev = of_find_device_by_node(np);
  62         if (!pdev) {
  63                 ret = -ENODEV;
  64                 goto err;
  65         }
  66
  67         match = mmc_pwrseq_find(np);
  68         if (IS_ERR(match)) {
  69                 ret = PTR_ERR(match);
  70                 goto err;
  71         }
  72
  73         ret = match->alloc(host, &pdev->dev);
  74         if (!ret)
  75                 dev_info(host->parent, "allocated mmc-pwrseq\n");
  76
  77 err:
  78         of_node_put(np);
  79         return ret;
  80 }
  81
  82 void mmc_pwrseq_pre_power_on(struct mmc_host *host)
  83 {
  84         struct mmc_pwrseq *pwrseq = host->pwrseq;
  85
  86         if (pwrseq && pwrseq->ops && pwrseq->ops->pre_power_on)
  87                 pwrseq->ops->pre_power_on(host);
  88 }
  89
  90 void mmc_pwrseq_post_power_on(struct mmc_host *host)
  91 {
  92         struct mmc_pwrseq *pwrseq = host->pwrseq;
  93
  94         if (pwrseq && pwrseq->ops && pwrseq->ops->post_power_on)
  95                 pwrseq->ops->post_power_on(host);
  96 }
  97
  98 void mmc_pwrseq_power_off(struct mmc_host *host)
  99 {
 100         struct mmc_pwrseq *pwrseq = host->pwrseq;
 101
 102         if (pwrseq && pwrseq->ops && pwrseq->ops->power_off)
 103                 pwrseq->ops->power_off(host);
 104 }
 105
 106 void mmc_pwrseq_free(struct mmc_host *host)
 107 {
 108         struct mmc_pwrseq *pwrseq = host->pwrseq;
 109
 110         if (pwrseq && pwrseq->ops && pwrseq->ops->free)
 111                 pwrseq->ops->free(host);
 112 }