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 <fdtdec.h>
10 #include <power-domain.h>
11 #include <power-domain-uclass.h>
12 
13 DECLARE_GLOBAL_DATA_PTR;
14 
15 static inline struct power_domain_ops *power_domain_dev_ops(struct udevice *dev)
16 {
17 	return (struct power_domain_ops *)dev->driver->ops;
18 }
19 
20 static int power_domain_of_xlate_default(struct power_domain *power_domain,
21 				       struct fdtdec_phandle_args *args)
22 {
23 	debug("%s(power_domain=%p)\n", __func__, power_domain);
24 
25 	if (args->args_count != 1) {
26 		debug("Invalid args_count: %d\n", args->args_count);
27 		return -EINVAL;
28 	}
29 
30 	power_domain->id = args->args[0];
31 
32 	return 0;
33 }
34 
35 int power_domain_get(struct udevice *dev, struct power_domain *power_domain)
36 {
37 	struct fdtdec_phandle_args args;
38 	int ret;
39 	struct udevice *dev_power_domain;
40 	struct power_domain_ops *ops;
41 
42 	debug("%s(dev=%p, power_domain=%p)\n", __func__, dev, power_domain);
43 
44 	ret = fdtdec_parse_phandle_with_args(gd->fdt_blob, dev_of_offset(dev),
45 					     "power-domains",
46 					     "#power-domain-cells", 0, 0,
47 					     &args);
48 	if (ret) {
49 		debug("%s: fdtdec_parse_phandle_with_args failed: %d\n",
50 		      __func__, ret);
51 		return ret;
52 	}
53 
54 	ret = uclass_get_device_by_of_offset(UCLASS_POWER_DOMAIN, args.node,
55 					     &dev_power_domain);
56 	if (ret) {
57 		debug("%s: uclass_get_device_by_of_offset failed: %d\n",
58 		      __func__, ret);
59 		return ret;
60 	}
61 	ops = power_domain_dev_ops(dev_power_domain);
62 
63 	power_domain->dev = dev_power_domain;
64 	if (ops->of_xlate)
65 		ret = ops->of_xlate(power_domain, &args);
66 	else
67 		ret = power_domain_of_xlate_default(power_domain, &args);
68 	if (ret) {
69 		debug("of_xlate() failed: %d\n", ret);
70 		return ret;
71 	}
72 
73 	ret = ops->request(power_domain);
74 	if (ret) {
75 		debug("ops->request() failed: %d\n", ret);
76 		return ret;
77 	}
78 
79 	return 0;
80 }
81 
82 int power_domain_free(struct power_domain *power_domain)
83 {
84 	struct power_domain_ops *ops = power_domain_dev_ops(power_domain->dev);
85 
86 	debug("%s(power_domain=%p)\n", __func__, power_domain);
87 
88 	return ops->free(power_domain);
89 }
90 
91 int power_domain_on(struct power_domain *power_domain)
92 {
93 	struct power_domain_ops *ops = power_domain_dev_ops(power_domain->dev);
94 
95 	debug("%s(power_domain=%p)\n", __func__, power_domain);
96 
97 	return ops->on(power_domain);
98 }
99 
100 int power_domain_off(struct power_domain *power_domain)
101 {
102 	struct power_domain_ops *ops = power_domain_dev_ops(power_domain->dev);
103 
104 	debug("%s(power_domain=%p)\n", __func__, power_domain);
105 
106 	return ops->off(power_domain);
107 }
108 
109 UCLASS_DRIVER(power_domain) = {
110 	.id		= UCLASS_POWER_DOMAIN,
111 	.name		= "power_domain",
112 };
113