1e2f05d60SEddie James // SPDX-License-Identifier: GPL-2.0+
2e2f05d60SEddie James // Copyright IBM Corp 2019
3df04ced6SEddie James
4df04ced6SEddie James #include <linux/bitops.h>
5df04ced6SEddie James #include <linux/device.h>
65679ed99SJean Delvare #include <linux/export.h>
7df04ced6SEddie James #include <linux/hwmon-sysfs.h>
8df04ced6SEddie James #include <linux/kernel.h>
9cf8e9f21SEddie James #include <linux/kstrtox.h>
10df04ced6SEddie James #include <linux/sysfs.h>
11df04ced6SEddie James
12df04ced6SEddie James #include "common.h"
13df04ced6SEddie James
14df04ced6SEddie James /* OCC status register */
15df04ced6SEddie James #define OCC_STAT_MASTER BIT(7)
16df04ced6SEddie James
17df04ced6SEddie James /* OCC extended status register */
18df04ced6SEddie James #define OCC_EXT_STAT_DVFS_OT BIT(7)
19df04ced6SEddie James #define OCC_EXT_STAT_DVFS_POWER BIT(6)
20df04ced6SEddie James #define OCC_EXT_STAT_MEM_THROTTLE BIT(5)
21df04ced6SEddie James #define OCC_EXT_STAT_QUICK_DROP BIT(4)
22daaee92eSEddie James #define OCC_EXT_STAT_DVFS_VDD BIT(3)
23daaee92eSEddie James #define OCC_EXT_STAT_GPU_THROTTLE GENMASK(2, 0)
24df04ced6SEddie James
occ_active_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)25cf8e9f21SEddie James static ssize_t occ_active_store(struct device *dev,
26cf8e9f21SEddie James struct device_attribute *attr,
27cf8e9f21SEddie James const char *buf, size_t count)
28cf8e9f21SEddie James {
29cf8e9f21SEddie James int rc;
30cf8e9f21SEddie James bool active;
31cf8e9f21SEddie James struct occ *occ = dev_get_drvdata(dev);
32cf8e9f21SEddie James
33cf8e9f21SEddie James rc = kstrtobool(buf, &active);
34cf8e9f21SEddie James if (rc)
35cf8e9f21SEddie James return rc;
36cf8e9f21SEddie James
37cf8e9f21SEddie James rc = occ_active(occ, active);
38cf8e9f21SEddie James if (rc)
39cf8e9f21SEddie James return rc;
40cf8e9f21SEddie James
41cf8e9f21SEddie James return count;
42cf8e9f21SEddie James }
43cf8e9f21SEddie James
occ_sysfs_show(struct device * dev,struct device_attribute * attr,char * buf)44df04ced6SEddie James static ssize_t occ_sysfs_show(struct device *dev,
45df04ced6SEddie James struct device_attribute *attr, char *buf)
46df04ced6SEddie James {
47df04ced6SEddie James int rc;
48df04ced6SEddie James int val = 0;
49df04ced6SEddie James struct occ *occ = dev_get_drvdata(dev);
50df04ced6SEddie James struct occ_poll_response_header *header;
51df04ced6SEddie James struct sensor_device_attribute *sattr = to_sensor_dev_attr(attr);
52df04ced6SEddie James
53cf8e9f21SEddie James if (occ->active) {
54df04ced6SEddie James rc = occ_update_response(occ);
55df04ced6SEddie James if (rc)
56df04ced6SEddie James return rc;
57df04ced6SEddie James
58df04ced6SEddie James header = (struct occ_poll_response_header *)occ->resp.data;
59df04ced6SEddie James
60df04ced6SEddie James switch (sattr->index) {
61df04ced6SEddie James case 0:
62df04ced6SEddie James val = !!(header->status & OCC_STAT_MASTER);
63df04ced6SEddie James break;
64df04ced6SEddie James case 1:
65cf8e9f21SEddie James val = 1;
66df04ced6SEddie James break;
67df04ced6SEddie James case 2:
68b88c5049SLei YU val = !!(header->ext_status & OCC_EXT_STAT_DVFS_OT);
69df04ced6SEddie James break;
70df04ced6SEddie James case 3:
71b88c5049SLei YU val = !!(header->ext_status & OCC_EXT_STAT_DVFS_POWER);
72df04ced6SEddie James break;
73df04ced6SEddie James case 4:
74cf8e9f21SEddie James val = !!(header->ext_status &
75cf8e9f21SEddie James OCC_EXT_STAT_MEM_THROTTLE);
76df04ced6SEddie James break;
77df04ced6SEddie James case 5:
78b88c5049SLei YU val = !!(header->ext_status & OCC_EXT_STAT_QUICK_DROP);
79df04ced6SEddie James break;
80df04ced6SEddie James case 6:
81df04ced6SEddie James val = header->occ_state;
82df04ced6SEddie James break;
83df04ced6SEddie James case 7:
84df04ced6SEddie James if (header->status & OCC_STAT_MASTER)
85df04ced6SEddie James val = hweight8(header->occs_present);
86df04ced6SEddie James else
87df04ced6SEddie James val = 1;
88df04ced6SEddie James break;
89afa95feeSEddie James case 8:
90afa95feeSEddie James val = header->ips_status;
91afa95feeSEddie James break;
926a0be74bSEddie James case 9:
936a0be74bSEddie James val = header->mode;
946a0be74bSEddie James break;
95daaee92eSEddie James case 10:
96daaee92eSEddie James val = !!(header->ext_status & OCC_EXT_STAT_DVFS_VDD);
97daaee92eSEddie James break;
98daaee92eSEddie James case 11:
99daaee92eSEddie James val = header->ext_status & OCC_EXT_STAT_GPU_THROTTLE;
100daaee92eSEddie James break;
101df04ced6SEddie James default:
102df04ced6SEddie James return -EINVAL;
103df04ced6SEddie James }
104cf8e9f21SEddie James } else {
105cf8e9f21SEddie James if (sattr->index == 1)
106cf8e9f21SEddie James val = 0;
107cf8e9f21SEddie James else if (sattr->index <= 11)
108cf8e9f21SEddie James val = -ENODATA;
109cf8e9f21SEddie James else
110cf8e9f21SEddie James return -EINVAL;
111cf8e9f21SEddie James }
112df04ced6SEddie James
1131f4d4af4SGuenter Roeck return sysfs_emit(buf, "%d\n", val);
114df04ced6SEddie James }
115df04ced6SEddie James
occ_error_show(struct device * dev,struct device_attribute * attr,char * buf)116afe8419eSEddie James static ssize_t occ_error_show(struct device *dev,
117afe8419eSEddie James struct device_attribute *attr, char *buf)
118afe8419eSEddie James {
119afe8419eSEddie James struct occ *occ = dev_get_drvdata(dev);
120afe8419eSEddie James
121afe8419eSEddie James occ_update_response(occ);
122afe8419eSEddie James
1231f4d4af4SGuenter Roeck return sysfs_emit(buf, "%d\n", occ->error);
124afe8419eSEddie James }
125afe8419eSEddie James
126df04ced6SEddie James static SENSOR_DEVICE_ATTR(occ_master, 0444, occ_sysfs_show, NULL, 0);
127cf8e9f21SEddie James static SENSOR_DEVICE_ATTR(occ_active, 0644, occ_sysfs_show, occ_active_store,
128cf8e9f21SEddie James 1);
129df04ced6SEddie James static SENSOR_DEVICE_ATTR(occ_dvfs_overtemp, 0444, occ_sysfs_show, NULL, 2);
130df04ced6SEddie James static SENSOR_DEVICE_ATTR(occ_dvfs_power, 0444, occ_sysfs_show, NULL, 3);
131df04ced6SEddie James static SENSOR_DEVICE_ATTR(occ_mem_throttle, 0444, occ_sysfs_show, NULL, 4);
132df04ced6SEddie James static SENSOR_DEVICE_ATTR(occ_quick_pwr_drop, 0444, occ_sysfs_show, NULL, 5);
133df04ced6SEddie James static SENSOR_DEVICE_ATTR(occ_state, 0444, occ_sysfs_show, NULL, 6);
134df04ced6SEddie James static SENSOR_DEVICE_ATTR(occs_present, 0444, occ_sysfs_show, NULL, 7);
135afa95feeSEddie James static SENSOR_DEVICE_ATTR(occ_ips_status, 0444, occ_sysfs_show, NULL, 8);
1366a0be74bSEddie James static SENSOR_DEVICE_ATTR(occ_mode, 0444, occ_sysfs_show, NULL, 9);
137daaee92eSEddie James static SENSOR_DEVICE_ATTR(occ_dvfs_vdd, 0444, occ_sysfs_show, NULL, 10);
138daaee92eSEddie James static SENSOR_DEVICE_ATTR(occ_gpu_throttle, 0444, occ_sysfs_show, NULL, 11);
139afe8419eSEddie James static DEVICE_ATTR_RO(occ_error);
140df04ced6SEddie James
141df04ced6SEddie James static struct attribute *occ_attributes[] = {
142df04ced6SEddie James &sensor_dev_attr_occ_master.dev_attr.attr,
143df04ced6SEddie James &sensor_dev_attr_occ_active.dev_attr.attr,
144df04ced6SEddie James &sensor_dev_attr_occ_dvfs_overtemp.dev_attr.attr,
145df04ced6SEddie James &sensor_dev_attr_occ_dvfs_power.dev_attr.attr,
146df04ced6SEddie James &sensor_dev_attr_occ_mem_throttle.dev_attr.attr,
147df04ced6SEddie James &sensor_dev_attr_occ_quick_pwr_drop.dev_attr.attr,
148df04ced6SEddie James &sensor_dev_attr_occ_state.dev_attr.attr,
149df04ced6SEddie James &sensor_dev_attr_occs_present.dev_attr.attr,
150afa95feeSEddie James &sensor_dev_attr_occ_ips_status.dev_attr.attr,
1516a0be74bSEddie James &sensor_dev_attr_occ_mode.dev_attr.attr,
152daaee92eSEddie James &sensor_dev_attr_occ_dvfs_vdd.dev_attr.attr,
153daaee92eSEddie James &sensor_dev_attr_occ_gpu_throttle.dev_attr.attr,
154afe8419eSEddie James &dev_attr_occ_error.attr,
155df04ced6SEddie James NULL
156df04ced6SEddie James };
157df04ced6SEddie James
158df04ced6SEddie James static const struct attribute_group occ_sysfs = {
159df04ced6SEddie James .attrs = occ_attributes,
160df04ced6SEddie James };
161df04ced6SEddie James
occ_sysfs_poll_done(struct occ * occ)162df04ced6SEddie James void occ_sysfs_poll_done(struct occ *occ)
163df04ced6SEddie James {
164df04ced6SEddie James const char *name;
165df04ced6SEddie James struct occ_poll_response_header *header =
166df04ced6SEddie James (struct occ_poll_response_header *)occ->resp.data;
167df04ced6SEddie James
168df04ced6SEddie James /*
169df04ced6SEddie James * On the first poll response, we haven't yet created the sysfs
170df04ced6SEddie James * attributes, so don't make any notify calls.
171df04ced6SEddie James */
172cf8e9f21SEddie James if (!occ->active)
173df04ced6SEddie James goto done;
174df04ced6SEddie James
175df04ced6SEddie James if ((header->status & OCC_STAT_MASTER) !=
176df04ced6SEddie James (occ->prev_stat & OCC_STAT_MASTER)) {
177df04ced6SEddie James name = sensor_dev_attr_occ_master.dev_attr.attr.name;
178df04ced6SEddie James sysfs_notify(&occ->bus_dev->kobj, NULL, name);
179df04ced6SEddie James }
180df04ced6SEddie James
181df04ced6SEddie James if ((header->ext_status & OCC_EXT_STAT_DVFS_OT) !=
182df04ced6SEddie James (occ->prev_ext_stat & OCC_EXT_STAT_DVFS_OT)) {
183df04ced6SEddie James name = sensor_dev_attr_occ_dvfs_overtemp.dev_attr.attr.name;
184df04ced6SEddie James sysfs_notify(&occ->bus_dev->kobj, NULL, name);
185df04ced6SEddie James }
186df04ced6SEddie James
187df04ced6SEddie James if ((header->ext_status & OCC_EXT_STAT_DVFS_POWER) !=
188df04ced6SEddie James (occ->prev_ext_stat & OCC_EXT_STAT_DVFS_POWER)) {
189df04ced6SEddie James name = sensor_dev_attr_occ_dvfs_power.dev_attr.attr.name;
190df04ced6SEddie James sysfs_notify(&occ->bus_dev->kobj, NULL, name);
191df04ced6SEddie James }
192df04ced6SEddie James
193df04ced6SEddie James if ((header->ext_status & OCC_EXT_STAT_MEM_THROTTLE) !=
194df04ced6SEddie James (occ->prev_ext_stat & OCC_EXT_STAT_MEM_THROTTLE)) {
195df04ced6SEddie James name = sensor_dev_attr_occ_mem_throttle.dev_attr.attr.name;
196df04ced6SEddie James sysfs_notify(&occ->bus_dev->kobj, NULL, name);
197df04ced6SEddie James }
198df04ced6SEddie James
199df04ced6SEddie James if ((header->ext_status & OCC_EXT_STAT_QUICK_DROP) !=
200df04ced6SEddie James (occ->prev_ext_stat & OCC_EXT_STAT_QUICK_DROP)) {
201df04ced6SEddie James name = sensor_dev_attr_occ_quick_pwr_drop.dev_attr.attr.name;
202df04ced6SEddie James sysfs_notify(&occ->bus_dev->kobj, NULL, name);
203df04ced6SEddie James }
204df04ced6SEddie James
205daaee92eSEddie James if ((header->ext_status & OCC_EXT_STAT_DVFS_VDD) !=
206daaee92eSEddie James (occ->prev_ext_stat & OCC_EXT_STAT_DVFS_VDD)) {
207daaee92eSEddie James name = sensor_dev_attr_occ_dvfs_vdd.dev_attr.attr.name;
208daaee92eSEddie James sysfs_notify(&occ->bus_dev->kobj, NULL, name);
209daaee92eSEddie James }
210daaee92eSEddie James
211daaee92eSEddie James if ((header->ext_status & OCC_EXT_STAT_GPU_THROTTLE) !=
212daaee92eSEddie James (occ->prev_ext_stat & OCC_EXT_STAT_GPU_THROTTLE)) {
213daaee92eSEddie James name = sensor_dev_attr_occ_gpu_throttle.dev_attr.attr.name;
214daaee92eSEddie James sysfs_notify(&occ->bus_dev->kobj, NULL, name);
215daaee92eSEddie James }
216daaee92eSEddie James
217df04ced6SEddie James if ((header->status & OCC_STAT_MASTER) &&
218df04ced6SEddie James header->occs_present != occ->prev_occs_present) {
219df04ced6SEddie James name = sensor_dev_attr_occs_present.dev_attr.attr.name;
220df04ced6SEddie James sysfs_notify(&occ->bus_dev->kobj, NULL, name);
221df04ced6SEddie James }
222df04ced6SEddie James
223afa95feeSEddie James if (header->ips_status != occ->prev_ips_status) {
224afa95feeSEddie James name = sensor_dev_attr_occ_ips_status.dev_attr.attr.name;
225afa95feeSEddie James sysfs_notify(&occ->bus_dev->kobj, NULL, name);
226afa95feeSEddie James }
227afa95feeSEddie James
2286a0be74bSEddie James if (header->mode != occ->prev_mode) {
2296a0be74bSEddie James name = sensor_dev_attr_occ_mode.dev_attr.attr.name;
2306a0be74bSEddie James sysfs_notify(&occ->bus_dev->kobj, NULL, name);
2316a0be74bSEddie James }
2326a0be74bSEddie James
233df04ced6SEddie James if (occ->error && occ->error != occ->prev_error) {
234afe8419eSEddie James name = dev_attr_occ_error.attr.name;
235df04ced6SEddie James sysfs_notify(&occ->bus_dev->kobj, NULL, name);
236df04ced6SEddie James }
237df04ced6SEddie James
238df04ced6SEddie James /* no notifications for OCC state; doesn't indicate error condition */
239df04ced6SEddie James
240df04ced6SEddie James done:
241df04ced6SEddie James occ->prev_error = occ->error;
242df04ced6SEddie James occ->prev_stat = header->status;
243df04ced6SEddie James occ->prev_ext_stat = header->ext_status;
244df04ced6SEddie James occ->prev_occs_present = header->occs_present;
245afa95feeSEddie James occ->prev_ips_status = header->ips_status;
2466a0be74bSEddie James occ->prev_mode = header->mode;
247df04ced6SEddie James }
248df04ced6SEddie James
occ_setup_sysfs(struct occ * occ)249df04ced6SEddie James int occ_setup_sysfs(struct occ *occ)
250df04ced6SEddie James {
251df04ced6SEddie James return sysfs_create_group(&occ->bus_dev->kobj, &occ_sysfs);
252df04ced6SEddie James }
253df04ced6SEddie James
occ_shutdown_sysfs(struct occ * occ)254cf8e9f21SEddie James void occ_shutdown_sysfs(struct occ *occ)
255df04ced6SEddie James {
256df04ced6SEddie James sysfs_remove_group(&occ->bus_dev->kobj, &occ_sysfs);
257df04ced6SEddie James }
258