drivers/power/domain/power-domain-uclass.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /*
   3  * Copyright (c) 2016, NVIDIA CORPORATION.
   4  */
   5
   6 #include <common.h>
   7 #include <dm.h>
   8 #include <power-domain.h>
   9 #include <power-domain-uclass.h>
  10 #include <dm/device-internal.h>
  11
  12 static inline struct power_domain_ops *power_domain_dev_ops(struct udevice *dev)
  13 {
  14         return (struct power_domain_ops *)dev->driver->ops;
  15 }
  16
  17 static int power_domain_of_xlate_default(struct power_domain *power_domain,
  18                                          struct ofnode_phandle_args *args)
  19 {
  20         debug("%s(power_domain=%p)\n", __func__, power_domain);
  21
  22         if (args->args_count != 1) {
  23                 debug("Invalid args_count: %d\n", args->args_count);
  24                 return -EINVAL;
  25         }
  26
  27         power_domain->id = args->args[0];
  28
  29         return 0;
  30 }
  31
  32 int power_domain_get_by_index(struct udevice *dev,
  33                               struct power_domain *power_domain, int index)
  34 {
  35         struct ofnode_phandle_args args;
  36         int ret;
  37         struct udevice *dev_power_domain;
  38         struct power_domain_ops *ops;
  39
  40         debug("%s(dev=%p, power_domain=%p)\n", __func__, dev, power_domain);
  41
  42         ret = dev_read_phandle_with_args(dev, "power-domains",
  43                                          "#power-domain-cells", 0, index,
  44                                          &args);
  45         if (ret) {
  46                 debug("%s: dev_read_phandle_with_args failed: %d\n",
  47                       __func__, ret);
  48                 return ret;
  49         }
  50
  51         ret = uclass_get_device_by_ofnode(UCLASS_POWER_DOMAIN, args.node,
  52                                           &dev_power_domain);
  53         if (ret) {
  54                 debug("%s: uclass_get_device_by_ofnode failed: %d\n",
  55                       __func__, ret);
  56                 return ret;
  57         }
  58         ops = power_domain_dev_ops(dev_power_domain);
  59
  60         power_domain->dev = dev_power_domain;
  61         if (ops->of_xlate)
  62                 ret = ops->of_xlate(power_domain, &args);
  63         else
  64                 ret = power_domain_of_xlate_default(power_domain, &args);
  65         if (ret) {
  66                 debug("of_xlate() failed: %d\n", ret);
  67                 return ret;
  68         }
  69
  70         ret = ops->request(power_domain);
  71         if (ret) {
  72                 debug("ops->request() failed: %d\n", ret);
  73                 return ret;
  74         }
  75
  76         return 0;
  77 }
  78
  79 int power_domain_get(struct udevice *dev, struct power_domain *power_domain)
  80 {
  81         return power_domain_get_by_index(dev, power_domain, 0);
  82 }
  83
  84 int power_domain_free(struct power_domain *power_domain)
  85 {
  86         struct power_domain_ops *ops = power_domain_dev_ops(power_domain->dev);
  87
  88         debug("%s(power_domain=%p)\n", __func__, power_domain);
  89
  90         return ops->rfree(power_domain);
  91 }
  92
  93 int power_domain_on(struct power_domain *power_domain)
  94 {
  95         struct power_domain_ops *ops = power_domain_dev_ops(power_domain->dev);
  96
  97         debug("%s(power_domain=%p)\n", __func__, power_domain);
  98
  99         return ops->on(power_domain);
 100 }
 101
 102 int power_domain_off(struct power_domain *power_domain)
 103 {
 104         struct power_domain_ops *ops = power_domain_dev_ops(power_domain->dev);
 105
 106         debug("%s(power_domain=%p)\n", __func__, power_domain);
 107
 108         return ops->off(power_domain);
 109 }
 110
 111 #if (CONFIG_IS_ENABLED(OF_CONTROL) && !CONFIG_IS_ENABLED(OF_PLATDATA))
 112 static int dev_power_domain_ctrl(struct udevice *dev, bool on)
 113 {
 114         struct power_domain pd;
 115         int i, count, ret = 0;
 116
 117         count = dev_count_phandle_with_args(dev, "power-domains",
 118                                             "#power-domain-cells");
 119         for (i = 0; i < count; i++) {
 120                 ret = power_domain_get_by_index(dev, &pd, i);
 121                 if (ret)
 122                         return ret;
 123                 if (on)
 124                         ret = power_domain_on(&pd);
 125                 else
 126                         ret = power_domain_off(&pd);
 127         }
 128
 129         /*
 130          * power_domain_get() bound the device, thus
 131          * we must remove it again to prevent unbinding
 132          * active devices (which would result in unbind
 133          * error).
 134          */
 135         if (count > 0 && !on)
 136                 device_remove(pd.dev, DM_REMOVE_NORMAL);
 137
 138         return ret;
 139 }
 140
 141 int dev_power_domain_on(struct udevice *dev)
 142 {
 143         return dev_power_domain_ctrl(dev, true);
 144 }
 145
 146 int dev_power_domain_off(struct udevice *dev)
 147 {
 148         return dev_power_domain_ctrl(dev, false);
 149 }
 150 #endif
 151
 152 UCLASS_DRIVER(power_domain) = {
 153         .id             = UCLASS_POWER_DOMAIN,
 154         .name           = "power_domain",
 155 };