1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  * PowerNV OPAL Powercap interface
4  *
5  * Copyright 2017 IBM Corp.
6  */
7 
8 #define pr_fmt(fmt)     "opal-powercap: " fmt
9 
10 #include <linux/of.h>
11 #include <linux/kobject.h>
12 #include <linux/slab.h>
13 
14 #include <asm/opal.h>
15 
16 static DEFINE_MUTEX(powercap_mutex);
17 
18 static struct kobject *powercap_kobj;
19 
20 struct powercap_attr {
21 	u32 handle;
22 	struct kobj_attribute attr;
23 };
24 
25 static struct pcap {
26 	struct attribute_group pg;
27 	struct powercap_attr *pattrs;
28 } *pcaps;
29 
powercap_show(struct kobject * kobj,struct kobj_attribute * attr,char * buf)30 static ssize_t powercap_show(struct kobject *kobj, struct kobj_attribute *attr,
31 			     char *buf)
32 {
33 	struct powercap_attr *pcap_attr = container_of(attr,
34 						struct powercap_attr, attr);
35 	struct opal_msg msg;
36 	u32 pcap;
37 	int ret, token;
38 
39 	token = opal_async_get_token_interruptible();
40 	if (token < 0) {
41 		pr_devel("Failed to get token\n");
42 		return token;
43 	}
44 
45 	ret = mutex_lock_interruptible(&powercap_mutex);
46 	if (ret)
47 		goto out_token;
48 
49 	ret = opal_get_powercap(pcap_attr->handle, token, (u32 *)__pa(&pcap));
50 	switch (ret) {
51 	case OPAL_ASYNC_COMPLETION:
52 		ret = opal_async_wait_response(token, &msg);
53 		if (ret) {
54 			pr_devel("Failed to wait for the async response\n");
55 			ret = -EIO;
56 			goto out;
57 		}
58 		ret = opal_error_code(opal_get_async_rc(msg));
59 		if (!ret) {
60 			ret = sprintf(buf, "%u\n", be32_to_cpu(pcap));
61 			if (ret < 0)
62 				ret = -EIO;
63 		}
64 		break;
65 	case OPAL_SUCCESS:
66 		ret = sprintf(buf, "%u\n", be32_to_cpu(pcap));
67 		if (ret < 0)
68 			ret = -EIO;
69 		break;
70 	default:
71 		ret = opal_error_code(ret);
72 	}
73 
74 out:
75 	mutex_unlock(&powercap_mutex);
76 out_token:
77 	opal_async_release_token(token);
78 	return ret;
79 }
80 
powercap_store(struct kobject * kobj,struct kobj_attribute * attr,const char * buf,size_t count)81 static ssize_t powercap_store(struct kobject *kobj,
82 			      struct kobj_attribute *attr, const char *buf,
83 			      size_t count)
84 {
85 	struct powercap_attr *pcap_attr = container_of(attr,
86 						struct powercap_attr, attr);
87 	struct opal_msg msg;
88 	u32 pcap;
89 	int ret, token;
90 
91 	ret = kstrtoint(buf, 0, &pcap);
92 	if (ret)
93 		return ret;
94 
95 	token = opal_async_get_token_interruptible();
96 	if (token < 0) {
97 		pr_devel("Failed to get token\n");
98 		return token;
99 	}
100 
101 	ret = mutex_lock_interruptible(&powercap_mutex);
102 	if (ret)
103 		goto out_token;
104 
105 	ret = opal_set_powercap(pcap_attr->handle, token, pcap);
106 	switch (ret) {
107 	case OPAL_ASYNC_COMPLETION:
108 		ret = opal_async_wait_response(token, &msg);
109 		if (ret) {
110 			pr_devel("Failed to wait for the async response\n");
111 			ret = -EIO;
112 			goto out;
113 		}
114 		ret = opal_error_code(opal_get_async_rc(msg));
115 		if (!ret)
116 			ret = count;
117 		break;
118 	case OPAL_SUCCESS:
119 		ret = count;
120 		break;
121 	default:
122 		ret = opal_error_code(ret);
123 	}
124 
125 out:
126 	mutex_unlock(&powercap_mutex);
127 out_token:
128 	opal_async_release_token(token);
129 	return ret;
130 }
131 
powercap_add_attr(int handle,const char * name,struct powercap_attr * attr)132 static void __init powercap_add_attr(int handle, const char *name,
133 			      struct powercap_attr *attr)
134 {
135 	attr->handle = handle;
136 	sysfs_attr_init(&attr->attr.attr);
137 	attr->attr.attr.name = name;
138 	attr->attr.attr.mode = 0444;
139 	attr->attr.show = powercap_show;
140 }
141 
opal_powercap_init(void)142 void __init opal_powercap_init(void)
143 {
144 	struct device_node *powercap, *node;
145 	int i = 0;
146 
147 	powercap = of_find_compatible_node(NULL, NULL, "ibm,opal-powercap");
148 	if (!powercap) {
149 		pr_devel("Powercap node not found\n");
150 		return;
151 	}
152 
153 	pcaps = kcalloc(of_get_child_count(powercap), sizeof(*pcaps),
154 			GFP_KERNEL);
155 	if (!pcaps)
156 		goto out_put_powercap;
157 
158 	powercap_kobj = kobject_create_and_add("powercap", opal_kobj);
159 	if (!powercap_kobj) {
160 		pr_warn("Failed to create powercap kobject\n");
161 		goto out_pcaps;
162 	}
163 
164 	i = 0;
165 	for_each_child_of_node(powercap, node) {
166 		u32 cur, min, max;
167 		int j = 0;
168 		bool has_cur = false, has_min = false, has_max = false;
169 
170 		if (!of_property_read_u32(node, "powercap-min", &min)) {
171 			j++;
172 			has_min = true;
173 		}
174 
175 		if (!of_property_read_u32(node, "powercap-max", &max)) {
176 			j++;
177 			has_max = true;
178 		}
179 
180 		if (!of_property_read_u32(node, "powercap-current", &cur)) {
181 			j++;
182 			has_cur = true;
183 		}
184 
185 		pcaps[i].pattrs = kcalloc(j, sizeof(struct powercap_attr),
186 					  GFP_KERNEL);
187 		if (!pcaps[i].pattrs)
188 			goto out_pcaps_pattrs;
189 
190 		pcaps[i].pg.attrs = kcalloc(j + 1, sizeof(struct attribute *),
191 					    GFP_KERNEL);
192 		if (!pcaps[i].pg.attrs) {
193 			kfree(pcaps[i].pattrs);
194 			goto out_pcaps_pattrs;
195 		}
196 
197 		j = 0;
198 		pcaps[i].pg.name = kasprintf(GFP_KERNEL, "%pOFn", node);
199 		if (!pcaps[i].pg.name) {
200 			kfree(pcaps[i].pattrs);
201 			kfree(pcaps[i].pg.attrs);
202 			goto out_pcaps_pattrs;
203 		}
204 
205 		if (has_min) {
206 			powercap_add_attr(min, "powercap-min",
207 					  &pcaps[i].pattrs[j]);
208 			pcaps[i].pg.attrs[j] = &pcaps[i].pattrs[j].attr.attr;
209 			j++;
210 		}
211 
212 		if (has_max) {
213 			powercap_add_attr(max, "powercap-max",
214 					  &pcaps[i].pattrs[j]);
215 			pcaps[i].pg.attrs[j] = &pcaps[i].pattrs[j].attr.attr;
216 			j++;
217 		}
218 
219 		if (has_cur) {
220 			powercap_add_attr(cur, "powercap-current",
221 					  &pcaps[i].pattrs[j]);
222 			pcaps[i].pattrs[j].attr.attr.mode |= 0220;
223 			pcaps[i].pattrs[j].attr.store = powercap_store;
224 			pcaps[i].pg.attrs[j] = &pcaps[i].pattrs[j].attr.attr;
225 			j++;
226 		}
227 
228 		if (sysfs_create_group(powercap_kobj, &pcaps[i].pg)) {
229 			pr_warn("Failed to create powercap attribute group %s\n",
230 				pcaps[i].pg.name);
231 			goto out_pcaps_pattrs;
232 		}
233 		i++;
234 	}
235 	of_node_put(powercap);
236 
237 	return;
238 
239 out_pcaps_pattrs:
240 	while (--i >= 0) {
241 		kfree(pcaps[i].pattrs);
242 		kfree(pcaps[i].pg.attrs);
243 		kfree(pcaps[i].pg.name);
244 	}
245 	kobject_put(powercap_kobj);
246 	of_node_put(node);
247 out_pcaps:
248 	kfree(pcaps);
249 out_put_powercap:
250 	of_node_put(powercap);
251 }
252