git.sur5r.net Git - u-boot/blob - drivers/power/domain/power-domain-uclass.c

   1 /*
   2  * Copyright (c) 2016, NVIDIA CORPORATION.
   3  *
   4  * SPDX-License-Identifier: GPL-2.0
   5  */
   6
   7 #include <common.h>
   8 #include <dm.h>
   9 #include <power-domain.h>
  10 #include <power-domain-uclass.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(struct udevice *dev, struct power_domain *power_domain)
  33 {
  34         struct ofnode_phandle_args args;
  35         int ret;
  36         struct udevice *dev_power_domain;
  37         struct power_domain_ops *ops;
  38
  39         debug("%s(dev=%p, power_domain=%p)\n", __func__, dev, power_domain);
  40
  41         ret = dev_read_phandle_with_args(dev, "power-domains",
  42                                          "#power-domain-cells", 0, 0, &args);
  43         if (ret) {
  44                 debug("%s: dev_read_phandle_with_args failed: %d\n",
  45                       __func__, ret);
  46                 return ret;
  47         }
  48
  49         ret = uclass_get_device_by_ofnode(UCLASS_POWER_DOMAIN, args.node,
  50                                           &dev_power_domain);
  51         if (ret) {
  52                 debug("%s: uclass_get_device_by_ofnode failed: %d\n",
  53                       __func__, ret);
  54                 return ret;
  55         }
  56         ops = power_domain_dev_ops(dev_power_domain);
  57
  58         power_domain->dev = dev_power_domain;
  59         if (ops->of_xlate)
  60                 ret = ops->of_xlate(power_domain, &args);
  61         else
  62                 ret = power_domain_of_xlate_default(power_domain, &args);
  63         if (ret) {
  64                 debug("of_xlate() failed: %d\n", ret);
  65                 return ret;
  66         }
  67
  68         ret = ops->request(power_domain);
  69         if (ret) {
  70                 debug("ops->request() failed: %d\n", ret);
  71                 return ret;
  72         }
  73
  74         return 0;
  75 }
  76
  77 int power_domain_free(struct power_domain *power_domain)
  78 {
  79         struct power_domain_ops *ops = power_domain_dev_ops(power_domain->dev);
  80
  81         debug("%s(power_domain=%p)\n", __func__, power_domain);
  82
  83         return ops->free(power_domain);
  84 }
  85
  86 int power_domain_on(struct power_domain *power_domain)
  87 {
  88         struct power_domain_ops *ops = power_domain_dev_ops(power_domain->dev);
  89
  90         debug("%s(power_domain=%p)\n", __func__, power_domain);
  91
  92         return ops->on(power_domain);
  93 }
  94
  95 int power_domain_off(struct power_domain *power_domain)
  96 {
  97         struct power_domain_ops *ops = power_domain_dev_ops(power_domain->dev);
  98
  99         debug("%s(power_domain=%p)\n", __func__, power_domain);
 100
 101         return ops->off(power_domain);
 102 }
 103
 104 UCLASS_DRIVER(power_domain) = {
 105         .id             = UCLASS_POWER_DOMAIN,
 106         .name           = "power_domain",
 107 };