1
2
3
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
12static inline struct power_domain_ops *power_domain_dev_ops(struct udevice *dev)
13{
14 return (struct power_domain_ops *)dev->driver->ops;
15}
16
17static 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
32int 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
79int 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
84int 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->free(power_domain);
91}
92
93int 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
102int 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))
112static 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
131
132
133
134
135 if (count > 0 && !on)
136 device_remove(pd.dev, DM_REMOVE_NORMAL);
137
138 return ret;
139}
140
141int dev_power_domain_on(struct udevice *dev)
142{
143 return dev_power_domain_ctrl(dev, true);
144}
145
146int dev_power_domain_off(struct udevice *dev)
147{
148 return dev_power_domain_ctrl(dev, false);
149}
150#endif
151
152UCLASS_DRIVER(power_domain) = {
153 .id = UCLASS_POWER_DOMAIN,
154 .name = "power_domain",
155};
156