blob: 11922c8358607b7f61d5e04dcee5e4f1462641da [file] [log] [blame]
Darrick J. Wongde584af2009-09-18 12:41:09 -07001/*
2 * A hwmon driver for ACPI 4.0 power meters
3 * Copyright (C) 2009 IBM
4 *
5 * Author: Darrick J. Wong <djwong@us.ibm.com>
6 *
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation; either version 2 of the License, or
10 * (at your option) any later version.
11 *
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
16 *
17 * You should have received a copy of the GNU General Public License
18 * along with this program; if not, write to the Free Software
19 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
20 */
21
22#include <linux/module.h>
23#include <linux/hwmon.h>
24#include <linux/hwmon-sysfs.h>
25#include <linux/jiffies.h>
26#include <linux/mutex.h>
27#include <linux/dmi.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090028#include <linux/slab.h>
Darrick J. Wongde584af2009-09-18 12:41:09 -070029#include <linux/kdev_t.h>
30#include <linux/sched.h>
31#include <linux/time.h>
32#include <acpi/acpi_drivers.h>
33#include <acpi/acpi_bus.h>
34
35#define ACPI_POWER_METER_NAME "power_meter"
36ACPI_MODULE_NAME(ACPI_POWER_METER_NAME);
37#define ACPI_POWER_METER_DEVICE_NAME "Power Meter"
Dan Carpenter18262712010-04-27 14:01:07 -070038#define ACPI_POWER_METER_CLASS "pwr_meter_resource"
Darrick J. Wongde584af2009-09-18 12:41:09 -070039
40#define NUM_SENSORS 17
41
42#define POWER_METER_CAN_MEASURE (1 << 0)
43#define POWER_METER_CAN_TRIP (1 << 1)
44#define POWER_METER_CAN_CAP (1 << 2)
45#define POWER_METER_CAN_NOTIFY (1 << 3)
46#define POWER_METER_IS_BATTERY (1 << 8)
47#define UNKNOWN_HYSTERESIS 0xFFFFFFFF
48
49#define METER_NOTIFY_CONFIG 0x80
50#define METER_NOTIFY_TRIP 0x81
51#define METER_NOTIFY_CAP 0x82
52#define METER_NOTIFY_CAPPING 0x83
53#define METER_NOTIFY_INTERVAL 0x84
54
55#define POWER_AVERAGE_NAME "power1_average"
56#define POWER_CAP_NAME "power1_cap"
57#define POWER_AVG_INTERVAL_NAME "power1_average_interval"
58#define POWER_ALARM_NAME "power1_alarm"
59
60static int cap_in_hardware;
Rusty Russell90ab5ee2012-01-13 09:32:20 +103061static bool force_cap_on;
Darrick J. Wongde584af2009-09-18 12:41:09 -070062
63static int can_cap_in_hardware(void)
64{
65 return force_cap_on || cap_in_hardware;
66}
67
Márton Némethc97adf92010-01-10 17:15:36 +010068static const struct acpi_device_id power_meter_ids[] = {
Darrick J. Wongde584af2009-09-18 12:41:09 -070069 {"ACPI000D", 0},
70 {"", 0},
71};
72MODULE_DEVICE_TABLE(acpi, power_meter_ids);
73
74struct acpi_power_meter_capabilities {
Lin Ming439913f2010-01-28 10:53:19 +080075 u64 flags;
76 u64 units;
77 u64 type;
78 u64 accuracy;
79 u64 sampling_time;
80 u64 min_avg_interval;
81 u64 max_avg_interval;
82 u64 hysteresis;
83 u64 configurable_cap;
84 u64 min_cap;
85 u64 max_cap;
Darrick J. Wongde584af2009-09-18 12:41:09 -070086};
87
88struct acpi_power_meter_resource {
89 struct acpi_device *acpi_dev;
90 acpi_bus_id name;
91 struct mutex lock;
92 struct device *hwmon_dev;
93 struct acpi_power_meter_capabilities caps;
94 acpi_string model_number;
95 acpi_string serial_number;
96 acpi_string oem_info;
Lin Ming439913f2010-01-28 10:53:19 +080097 u64 power;
98 u64 cap;
99 u64 avg_interval;
Darrick J. Wongde584af2009-09-18 12:41:09 -0700100 int sensors_valid;
101 unsigned long sensors_last_updated;
102 struct sensor_device_attribute sensors[NUM_SENSORS];
103 int num_sensors;
104 int trip[2];
105 int num_domain_devices;
106 struct acpi_device **domain_devices;
107 struct kobject *holders_dir;
108};
109
Kyle McMartin81194cd2012-04-02 14:19:00 -0400110struct sensor_template {
Darrick J. Wongde584af2009-09-18 12:41:09 -0700111 char *label;
112 ssize_t (*show)(struct device *dev,
113 struct device_attribute *devattr,
114 char *buf);
115 ssize_t (*set)(struct device *dev,
116 struct device_attribute *devattr,
117 const char *buf, size_t count);
118 int index;
119};
120
121/* Averaging interval */
122static int update_avg_interval(struct acpi_power_meter_resource *resource)
123{
124 unsigned long long data;
125 acpi_status status;
126
127 status = acpi_evaluate_integer(resource->acpi_dev->handle, "_GAI",
128 NULL, &data);
129 if (ACPI_FAILURE(status)) {
130 ACPI_EXCEPTION((AE_INFO, status, "Evaluating _GAI"));
131 return -ENODEV;
132 }
133
134 resource->avg_interval = data;
135 return 0;
136}
137
138static ssize_t show_avg_interval(struct device *dev,
139 struct device_attribute *devattr,
140 char *buf)
141{
142 struct acpi_device *acpi_dev = to_acpi_device(dev);
143 struct acpi_power_meter_resource *resource = acpi_dev->driver_data;
144
145 mutex_lock(&resource->lock);
146 update_avg_interval(resource);
147 mutex_unlock(&resource->lock);
148
149 return sprintf(buf, "%llu\n", resource->avg_interval);
150}
151
152static ssize_t set_avg_interval(struct device *dev,
153 struct device_attribute *devattr,
154 const char *buf, size_t count)
155{
156 struct acpi_device *acpi_dev = to_acpi_device(dev);
157 struct acpi_power_meter_resource *resource = acpi_dev->driver_data;
158 union acpi_object arg0 = { ACPI_TYPE_INTEGER };
159 struct acpi_object_list args = { 1, &arg0 };
160 int res;
161 unsigned long temp;
162 unsigned long long data;
163 acpi_status status;
164
Frans Meulenbroeks179c4fd2012-01-04 20:58:52 +0100165 res = kstrtoul(buf, 10, &temp);
Darrick J. Wongde584af2009-09-18 12:41:09 -0700166 if (res)
167 return res;
168
169 if (temp > resource->caps.max_avg_interval ||
170 temp < resource->caps.min_avg_interval)
171 return -EINVAL;
172 arg0.integer.value = temp;
173
174 mutex_lock(&resource->lock);
175 status = acpi_evaluate_integer(resource->acpi_dev->handle, "_PAI",
176 &args, &data);
177 if (!ACPI_FAILURE(status))
178 resource->avg_interval = temp;
179 mutex_unlock(&resource->lock);
180
181 if (ACPI_FAILURE(status)) {
182 ACPI_EXCEPTION((AE_INFO, status, "Evaluating _PAI"));
183 return -EINVAL;
184 }
185
186 /* _PAI returns 0 on success, nonzero otherwise */
187 if (data)
188 return -EINVAL;
189
190 return count;
191}
192
193/* Cap functions */
194static int update_cap(struct acpi_power_meter_resource *resource)
195{
196 unsigned long long data;
197 acpi_status status;
198
199 status = acpi_evaluate_integer(resource->acpi_dev->handle, "_GHL",
200 NULL, &data);
201 if (ACPI_FAILURE(status)) {
202 ACPI_EXCEPTION((AE_INFO, status, "Evaluating _GHL"));
203 return -ENODEV;
204 }
205
206 resource->cap = data;
207 return 0;
208}
209
210static ssize_t show_cap(struct device *dev,
211 struct device_attribute *devattr,
212 char *buf)
213{
214 struct acpi_device *acpi_dev = to_acpi_device(dev);
215 struct acpi_power_meter_resource *resource = acpi_dev->driver_data;
216
217 mutex_lock(&resource->lock);
218 update_cap(resource);
219 mutex_unlock(&resource->lock);
220
221 return sprintf(buf, "%llu\n", resource->cap * 1000);
222}
223
224static ssize_t set_cap(struct device *dev, struct device_attribute *devattr,
225 const char *buf, size_t count)
226{
227 struct acpi_device *acpi_dev = to_acpi_device(dev);
228 struct acpi_power_meter_resource *resource = acpi_dev->driver_data;
229 union acpi_object arg0 = { ACPI_TYPE_INTEGER };
230 struct acpi_object_list args = { 1, &arg0 };
231 int res;
232 unsigned long temp;
233 unsigned long long data;
234 acpi_status status;
235
Frans Meulenbroeks179c4fd2012-01-04 20:58:52 +0100236 res = kstrtoul(buf, 10, &temp);
Darrick J. Wongde584af2009-09-18 12:41:09 -0700237 if (res)
238 return res;
239
240 temp /= 1000;
241 if (temp > resource->caps.max_cap || temp < resource->caps.min_cap)
242 return -EINVAL;
243 arg0.integer.value = temp;
244
245 mutex_lock(&resource->lock);
246 status = acpi_evaluate_integer(resource->acpi_dev->handle, "_SHL",
247 &args, &data);
248 if (!ACPI_FAILURE(status))
249 resource->cap = temp;
250 mutex_unlock(&resource->lock);
251
252 if (ACPI_FAILURE(status)) {
253 ACPI_EXCEPTION((AE_INFO, status, "Evaluating _SHL"));
254 return -EINVAL;
255 }
256
257 /* _SHL returns 0 on success, nonzero otherwise */
258 if (data)
259 return -EINVAL;
260
261 return count;
262}
263
264/* Power meter trip points */
265static int set_acpi_trip(struct acpi_power_meter_resource *resource)
266{
267 union acpi_object arg_objs[] = {
268 {ACPI_TYPE_INTEGER},
269 {ACPI_TYPE_INTEGER}
270 };
271 struct acpi_object_list args = { 2, arg_objs };
272 unsigned long long data;
273 acpi_status status;
274
275 /* Both trip levels must be set */
276 if (resource->trip[0] < 0 || resource->trip[1] < 0)
277 return 0;
278
279 /* This driver stores min, max; ACPI wants max, min. */
280 arg_objs[0].integer.value = resource->trip[1];
281 arg_objs[1].integer.value = resource->trip[0];
282
283 status = acpi_evaluate_integer(resource->acpi_dev->handle, "_PTP",
284 &args, &data);
285 if (ACPI_FAILURE(status)) {
286 ACPI_EXCEPTION((AE_INFO, status, "Evaluating _PTP"));
287 return -EINVAL;
288 }
289
Darrick J. Wong22aeceb2009-10-21 18:01:37 -0700290 /* _PTP returns 0 on success, nonzero otherwise */
291 if (data)
292 return -EINVAL;
293
294 return 0;
Darrick J. Wongde584af2009-09-18 12:41:09 -0700295}
296
297static ssize_t set_trip(struct device *dev, struct device_attribute *devattr,
298 const char *buf, size_t count)
299{
300 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
301 struct acpi_device *acpi_dev = to_acpi_device(dev);
302 struct acpi_power_meter_resource *resource = acpi_dev->driver_data;
303 int res;
304 unsigned long temp;
305
Frans Meulenbroeks179c4fd2012-01-04 20:58:52 +0100306 res = kstrtoul(buf, 10, &temp);
Darrick J. Wongde584af2009-09-18 12:41:09 -0700307 if (res)
308 return res;
309
310 temp /= 1000;
311 if (temp < 0)
312 return -EINVAL;
313
314 mutex_lock(&resource->lock);
315 resource->trip[attr->index - 7] = temp;
316 res = set_acpi_trip(resource);
317 mutex_unlock(&resource->lock);
318
319 if (res)
320 return res;
321
322 return count;
323}
324
325/* Power meter */
326static int update_meter(struct acpi_power_meter_resource *resource)
327{
328 unsigned long long data;
329 acpi_status status;
330 unsigned long local_jiffies = jiffies;
331
332 if (time_before(local_jiffies, resource->sensors_last_updated +
333 msecs_to_jiffies(resource->caps.sampling_time)) &&
334 resource->sensors_valid)
335 return 0;
336
337 status = acpi_evaluate_integer(resource->acpi_dev->handle, "_PMM",
338 NULL, &data);
339 if (ACPI_FAILURE(status)) {
340 ACPI_EXCEPTION((AE_INFO, status, "Evaluating _PMM"));
341 return -ENODEV;
342 }
343
344 resource->power = data;
345 resource->sensors_valid = 1;
346 resource->sensors_last_updated = jiffies;
347 return 0;
348}
349
350static ssize_t show_power(struct device *dev,
351 struct device_attribute *devattr,
352 char *buf)
353{
354 struct acpi_device *acpi_dev = to_acpi_device(dev);
355 struct acpi_power_meter_resource *resource = acpi_dev->driver_data;
356
357 mutex_lock(&resource->lock);
358 update_meter(resource);
359 mutex_unlock(&resource->lock);
360
361 return sprintf(buf, "%llu\n", resource->power * 1000);
362}
363
364/* Miscellaneous */
365static ssize_t show_str(struct device *dev,
366 struct device_attribute *devattr,
367 char *buf)
368{
369 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
370 struct acpi_device *acpi_dev = to_acpi_device(dev);
371 struct acpi_power_meter_resource *resource = acpi_dev->driver_data;
372 acpi_string val;
373
374 switch (attr->index) {
375 case 0:
376 val = resource->model_number;
377 break;
378 case 1:
379 val = resource->serial_number;
380 break;
381 case 2:
382 val = resource->oem_info;
383 break;
384 default:
385 BUG();
Guenter Roeck776cdc12012-03-28 09:03:26 -0700386 val = "";
Darrick J. Wongde584af2009-09-18 12:41:09 -0700387 }
388
389 return sprintf(buf, "%s\n", val);
390}
391
392static ssize_t show_val(struct device *dev,
393 struct device_attribute *devattr,
394 char *buf)
395{
396 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
397 struct acpi_device *acpi_dev = to_acpi_device(dev);
398 struct acpi_power_meter_resource *resource = acpi_dev->driver_data;
Lin Ming439913f2010-01-28 10:53:19 +0800399 u64 val = 0;
Darrick J. Wongde584af2009-09-18 12:41:09 -0700400
401 switch (attr->index) {
402 case 0:
403 val = resource->caps.min_avg_interval;
404 break;
405 case 1:
406 val = resource->caps.max_avg_interval;
407 break;
408 case 2:
409 val = resource->caps.min_cap * 1000;
410 break;
411 case 3:
412 val = resource->caps.max_cap * 1000;
413 break;
414 case 4:
415 if (resource->caps.hysteresis == UNKNOWN_HYSTERESIS)
416 return sprintf(buf, "unknown\n");
417
418 val = resource->caps.hysteresis * 1000;
419 break;
420 case 5:
421 if (resource->caps.flags & POWER_METER_IS_BATTERY)
422 val = 1;
423 else
424 val = 0;
425 break;
426 case 6:
427 if (resource->power > resource->cap)
428 val = 1;
429 else
430 val = 0;
431 break;
432 case 7:
433 case 8:
434 if (resource->trip[attr->index - 7] < 0)
435 return sprintf(buf, "unknown\n");
436
437 val = resource->trip[attr->index - 7] * 1000;
438 break;
439 default:
440 BUG();
441 }
442
443 return sprintf(buf, "%llu\n", val);
444}
445
446static ssize_t show_accuracy(struct device *dev,
447 struct device_attribute *devattr,
448 char *buf)
449{
450 struct acpi_device *acpi_dev = to_acpi_device(dev);
451 struct acpi_power_meter_resource *resource = acpi_dev->driver_data;
452 unsigned int acc = resource->caps.accuracy;
453
454 return sprintf(buf, "%u.%u%%\n", acc / 1000, acc % 1000);
455}
456
457static ssize_t show_name(struct device *dev,
458 struct device_attribute *devattr,
459 char *buf)
460{
461 return sprintf(buf, "%s\n", ACPI_POWER_METER_NAME);
462}
463
Kyle McMartin3c45f2c2012-04-02 14:19:01 -0400464#define RO_SENSOR_TEMPLATE(_label, _show, _index) \
465 { \
466 .label = _label, \
467 .show = _show, \
468 .index = _index, \
469 }
470
471#define RW_SENSOR_TEMPLATE(_label, _show, _set, _index) \
472 { \
473 .label = _label, \
474 .show = _show, \
475 .set = _set, \
476 .index = _index, \
477 }
478
Darrick J. Wongde584af2009-09-18 12:41:09 -0700479/* Sensor descriptions. If you add a sensor, update NUM_SENSORS above! */
Kyle McMartin81194cd2012-04-02 14:19:00 -0400480static struct sensor_template meter_ro_attrs[] = {
Kyle McMartin3c45f2c2012-04-02 14:19:01 -0400481 RO_SENSOR_TEMPLATE(POWER_AVERAGE_NAME, show_power, 0),
482 RO_SENSOR_TEMPLATE("power1_accuracy", show_accuracy, 0),
483 RO_SENSOR_TEMPLATE("power1_average_interval_min", show_val, 0),
484 RO_SENSOR_TEMPLATE("power1_average_interval_max", show_val, 1),
485 RO_SENSOR_TEMPLATE("power1_is_battery", show_val, 5),
Kyle McMartin81194cd2012-04-02 14:19:00 -0400486 {},
Darrick J. Wongde584af2009-09-18 12:41:09 -0700487};
488
Kyle McMartin81194cd2012-04-02 14:19:00 -0400489static struct sensor_template meter_rw_attrs[] = {
Kyle McMartin3c45f2c2012-04-02 14:19:01 -0400490 RW_SENSOR_TEMPLATE(POWER_AVG_INTERVAL_NAME, show_avg_interval,
491 set_avg_interval, 0),
Kyle McMartin81194cd2012-04-02 14:19:00 -0400492 {},
Darrick J. Wongde584af2009-09-18 12:41:09 -0700493};
494
Kyle McMartin81194cd2012-04-02 14:19:00 -0400495static struct sensor_template misc_cap_attrs[] = {
Kyle McMartin3c45f2c2012-04-02 14:19:01 -0400496 RO_SENSOR_TEMPLATE("power1_cap_min", show_val, 2),
497 RO_SENSOR_TEMPLATE("power1_cap_max", show_val, 3),
498 RO_SENSOR_TEMPLATE("power1_cap_hyst", show_val, 4),
499 RO_SENSOR_TEMPLATE(POWER_ALARM_NAME, show_val, 6),
Kyle McMartin81194cd2012-04-02 14:19:00 -0400500 {},
Darrick J. Wongde584af2009-09-18 12:41:09 -0700501};
502
Kyle McMartin81194cd2012-04-02 14:19:00 -0400503static struct sensor_template ro_cap_attrs[] = {
Kyle McMartin3c45f2c2012-04-02 14:19:01 -0400504 RO_SENSOR_TEMPLATE(POWER_CAP_NAME, show_cap, 0),
Kyle McMartin81194cd2012-04-02 14:19:00 -0400505 {},
Darrick J. Wongde584af2009-09-18 12:41:09 -0700506};
507
Kyle McMartin81194cd2012-04-02 14:19:00 -0400508static struct sensor_template rw_cap_attrs[] = {
Kyle McMartin3c45f2c2012-04-02 14:19:01 -0400509 RW_SENSOR_TEMPLATE(POWER_CAP_NAME, show_cap, set_cap, 0),
Kyle McMartin81194cd2012-04-02 14:19:00 -0400510 {},
Darrick J. Wongde584af2009-09-18 12:41:09 -0700511};
512
Kyle McMartin81194cd2012-04-02 14:19:00 -0400513static struct sensor_template trip_attrs[] = {
Kyle McMartin3c45f2c2012-04-02 14:19:01 -0400514 RW_SENSOR_TEMPLATE("power1_average_min", show_val, set_trip, 7),
515 RW_SENSOR_TEMPLATE("power1_average_max", show_val, set_trip, 8),
Kyle McMartin81194cd2012-04-02 14:19:00 -0400516 {},
Darrick J. Wongde584af2009-09-18 12:41:09 -0700517};
518
Kyle McMartin81194cd2012-04-02 14:19:00 -0400519static struct sensor_template misc_attrs[] = {
Kyle McMartin3c45f2c2012-04-02 14:19:01 -0400520 RO_SENSOR_TEMPLATE("name", show_name, 0),
521 RO_SENSOR_TEMPLATE("power1_model_number", show_str, 0),
522 RO_SENSOR_TEMPLATE("power1_oem_info", show_str, 2),
523 RO_SENSOR_TEMPLATE("power1_serial_number", show_str, 1),
Kyle McMartin81194cd2012-04-02 14:19:00 -0400524 {},
Darrick J. Wongde584af2009-09-18 12:41:09 -0700525};
526
Kyle McMartin3c45f2c2012-04-02 14:19:01 -0400527#undef RO_SENSOR_TEMPLATE
528#undef RW_SENSOR_TEMPLATE
529
Darrick J. Wongde584af2009-09-18 12:41:09 -0700530/* Read power domain data */
531static void remove_domain_devices(struct acpi_power_meter_resource *resource)
532{
533 int i;
534
535 if (!resource->num_domain_devices)
536 return;
537
538 for (i = 0; i < resource->num_domain_devices; i++) {
539 struct acpi_device *obj = resource->domain_devices[i];
540 if (!obj)
541 continue;
542
543 sysfs_remove_link(resource->holders_dir,
544 kobject_name(&obj->dev.kobj));
545 put_device(&obj->dev);
546 }
547
548 kfree(resource->domain_devices);
549 kobject_put(resource->holders_dir);
Darren Jenkins7f07a602010-01-12 23:37:07 +1100550 resource->num_domain_devices = 0;
Darrick J. Wongde584af2009-09-18 12:41:09 -0700551}
552
553static int read_domain_devices(struct acpi_power_meter_resource *resource)
554{
555 int res = 0;
556 int i;
557 struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
558 union acpi_object *pss;
559 acpi_status status;
560
561 status = acpi_evaluate_object(resource->acpi_dev->handle, "_PMD", NULL,
562 &buffer);
563 if (ACPI_FAILURE(status)) {
564 ACPI_EXCEPTION((AE_INFO, status, "Evaluating _PMD"));
565 return -ENODEV;
566 }
567
568 pss = buffer.pointer;
569 if (!pss ||
570 pss->type != ACPI_TYPE_PACKAGE) {
571 dev_err(&resource->acpi_dev->dev, ACPI_POWER_METER_NAME
572 "Invalid _PMD data\n");
573 res = -EFAULT;
574 goto end;
575 }
576
577 if (!pss->package.count)
578 goto end;
579
580 resource->domain_devices = kzalloc(sizeof(struct acpi_device *) *
581 pss->package.count, GFP_KERNEL);
582 if (!resource->domain_devices) {
583 res = -ENOMEM;
584 goto end;
585 }
586
587 resource->holders_dir = kobject_create_and_add("measures",
588 &resource->acpi_dev->dev.kobj);
589 if (!resource->holders_dir) {
590 res = -ENOMEM;
591 goto exit_free;
592 }
593
594 resource->num_domain_devices = pss->package.count;
595
596 for (i = 0; i < pss->package.count; i++) {
597 struct acpi_device *obj;
598 union acpi_object *element = &(pss->package.elements[i]);
599
600 /* Refuse non-references */
601 if (element->type != ACPI_TYPE_LOCAL_REFERENCE)
602 continue;
603
604 /* Create a symlink to domain objects */
605 resource->domain_devices[i] = NULL;
606 status = acpi_bus_get_device(element->reference.handle,
607 &resource->domain_devices[i]);
608 if (ACPI_FAILURE(status))
609 continue;
610
611 obj = resource->domain_devices[i];
612 get_device(&obj->dev);
613
614 res = sysfs_create_link(resource->holders_dir, &obj->dev.kobj,
615 kobject_name(&obj->dev.kobj));
616 if (res) {
617 put_device(&obj->dev);
618 resource->domain_devices[i] = NULL;
619 }
620 }
621
622 res = 0;
623 goto end;
624
625exit_free:
626 kfree(resource->domain_devices);
627end:
628 kfree(buffer.pointer);
629 return res;
630}
631
632/* Registration and deregistration */
633static int register_ro_attrs(struct acpi_power_meter_resource *resource,
Kyle McMartin81194cd2012-04-02 14:19:00 -0400634 struct sensor_template *ro)
Darrick J. Wongde584af2009-09-18 12:41:09 -0700635{
636 struct device *dev = &resource->acpi_dev->dev;
637 struct sensor_device_attribute *sensors =
638 &resource->sensors[resource->num_sensors];
639 int res = 0;
640
641 while (ro->label) {
642 sensors->dev_attr.attr.name = ro->label;
643 sensors->dev_attr.attr.mode = S_IRUGO;
644 sensors->dev_attr.show = ro->show;
645 sensors->index = ro->index;
646
Kyle McMartin31e354e2012-03-28 15:11:47 -0400647 sysfs_attr_init(&sensors->dev_attr.attr);
Darrick J. Wongde584af2009-09-18 12:41:09 -0700648 res = device_create_file(dev, &sensors->dev_attr);
649 if (res) {
650 sensors->dev_attr.attr.name = NULL;
651 goto error;
652 }
653 sensors++;
654 resource->num_sensors++;
655 ro++;
656 }
657
658error:
659 return res;
660}
661
662static int register_rw_attrs(struct acpi_power_meter_resource *resource,
Kyle McMartin81194cd2012-04-02 14:19:00 -0400663 struct sensor_template *rw)
Darrick J. Wongde584af2009-09-18 12:41:09 -0700664{
665 struct device *dev = &resource->acpi_dev->dev;
666 struct sensor_device_attribute *sensors =
667 &resource->sensors[resource->num_sensors];
668 int res = 0;
669
670 while (rw->label) {
671 sensors->dev_attr.attr.name = rw->label;
672 sensors->dev_attr.attr.mode = S_IRUGO | S_IWUSR;
673 sensors->dev_attr.show = rw->show;
674 sensors->dev_attr.store = rw->set;
675 sensors->index = rw->index;
676
Kyle McMartin31e354e2012-03-28 15:11:47 -0400677 sysfs_attr_init(&sensors->dev_attr.attr);
Darrick J. Wongde584af2009-09-18 12:41:09 -0700678 res = device_create_file(dev, &sensors->dev_attr);
679 if (res) {
680 sensors->dev_attr.attr.name = NULL;
681 goto error;
682 }
683 sensors++;
684 resource->num_sensors++;
685 rw++;
686 }
687
688error:
689 return res;
690}
691
692static void remove_attrs(struct acpi_power_meter_resource *resource)
693{
694 int i;
695
696 for (i = 0; i < resource->num_sensors; i++) {
697 if (!resource->sensors[i].dev_attr.attr.name)
698 continue;
699 device_remove_file(&resource->acpi_dev->dev,
700 &resource->sensors[i].dev_attr);
701 }
702
703 remove_domain_devices(resource);
704
705 resource->num_sensors = 0;
706}
707
708static int setup_attrs(struct acpi_power_meter_resource *resource)
709{
710 int res = 0;
711
712 res = read_domain_devices(resource);
713 if (res)
714 return res;
715
716 if (resource->caps.flags & POWER_METER_CAN_MEASURE) {
717 res = register_ro_attrs(resource, meter_ro_attrs);
718 if (res)
719 goto error;
720 res = register_rw_attrs(resource, meter_rw_attrs);
721 if (res)
722 goto error;
723 }
724
725 if (resource->caps.flags & POWER_METER_CAN_CAP) {
726 if (!can_cap_in_hardware()) {
727 dev_err(&resource->acpi_dev->dev,
728 "Ignoring unsafe software power cap!\n");
729 goto skip_unsafe_cap;
730 }
731
732 if (resource->caps.configurable_cap) {
733 res = register_rw_attrs(resource, rw_cap_attrs);
734 if (res)
735 goto error;
736 } else {
737 res = register_ro_attrs(resource, ro_cap_attrs);
738 if (res)
739 goto error;
740 }
741 res = register_ro_attrs(resource, misc_cap_attrs);
742 if (res)
743 goto error;
744 }
745skip_unsafe_cap:
746
747 if (resource->caps.flags & POWER_METER_CAN_TRIP) {
748 res = register_rw_attrs(resource, trip_attrs);
749 if (res)
750 goto error;
751 }
752
753 res = register_ro_attrs(resource, misc_attrs);
754 if (res)
755 goto error;
756
757 return res;
758error:
Darrick J. Wongde584af2009-09-18 12:41:09 -0700759 remove_attrs(resource);
760 return res;
761}
762
763static void free_capabilities(struct acpi_power_meter_resource *resource)
764{
765 acpi_string *str;
766 int i;
767
768 str = &resource->model_number;
769 for (i = 0; i < 3; i++, str++)
770 kfree(*str);
771}
772
773static int read_capabilities(struct acpi_power_meter_resource *resource)
774{
775 int res = 0;
776 int i;
777 struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
778 struct acpi_buffer state = { 0, NULL };
779 struct acpi_buffer format = { sizeof("NNNNNNNNNNN"), "NNNNNNNNNNN" };
780 union acpi_object *pss;
781 acpi_string *str;
782 acpi_status status;
783
784 status = acpi_evaluate_object(resource->acpi_dev->handle, "_PMC", NULL,
785 &buffer);
786 if (ACPI_FAILURE(status)) {
787 ACPI_EXCEPTION((AE_INFO, status, "Evaluating _PMC"));
788 return -ENODEV;
789 }
790
791 pss = buffer.pointer;
792 if (!pss ||
793 pss->type != ACPI_TYPE_PACKAGE ||
794 pss->package.count != 14) {
795 dev_err(&resource->acpi_dev->dev, ACPI_POWER_METER_NAME
796 "Invalid _PMC data\n");
797 res = -EFAULT;
798 goto end;
799 }
800
801 /* Grab all the integer data at once */
802 state.length = sizeof(struct acpi_power_meter_capabilities);
803 state.pointer = &resource->caps;
804
805 status = acpi_extract_package(pss, &format, &state);
806 if (ACPI_FAILURE(status)) {
807 ACPI_EXCEPTION((AE_INFO, status, "Invalid data"));
808 res = -EFAULT;
809 goto end;
810 }
811
812 if (resource->caps.units) {
813 dev_err(&resource->acpi_dev->dev, ACPI_POWER_METER_NAME
814 "Unknown units %llu.\n",
815 resource->caps.units);
816 res = -EINVAL;
817 goto end;
818 }
819
820 /* Grab the string data */
821 str = &resource->model_number;
822
823 for (i = 11; i < 14; i++) {
824 union acpi_object *element = &(pss->package.elements[i]);
825
826 if (element->type != ACPI_TYPE_STRING) {
827 res = -EINVAL;
828 goto error;
829 }
830
831 *str = kzalloc(sizeof(u8) * (element->string.length + 1),
832 GFP_KERNEL);
833 if (!*str) {
834 res = -ENOMEM;
835 goto error;
836 }
837
838 strncpy(*str, element->string.pointer, element->string.length);
839 str++;
840 }
841
842 dev_info(&resource->acpi_dev->dev, "Found ACPI power meter.\n");
843 goto end;
844error:
845 str = &resource->model_number;
846 for (i = 0; i < 3; i++, str++)
847 kfree(*str);
848end:
849 kfree(buffer.pointer);
850 return res;
851}
852
853/* Handle ACPI event notifications */
854static void acpi_power_meter_notify(struct acpi_device *device, u32 event)
855{
856 struct acpi_power_meter_resource *resource;
857 int res;
858
859 if (!device || !acpi_driver_data(device))
860 return;
861
862 resource = acpi_driver_data(device);
863
864 mutex_lock(&resource->lock);
865 switch (event) {
866 case METER_NOTIFY_CONFIG:
867 free_capabilities(resource);
868 res = read_capabilities(resource);
869 if (res)
870 break;
871
872 remove_attrs(resource);
873 setup_attrs(resource);
874 break;
875 case METER_NOTIFY_TRIP:
876 sysfs_notify(&device->dev.kobj, NULL, POWER_AVERAGE_NAME);
877 update_meter(resource);
878 break;
879 case METER_NOTIFY_CAP:
880 sysfs_notify(&device->dev.kobj, NULL, POWER_CAP_NAME);
881 update_cap(resource);
882 break;
883 case METER_NOTIFY_INTERVAL:
884 sysfs_notify(&device->dev.kobj, NULL, POWER_AVG_INTERVAL_NAME);
885 update_avg_interval(resource);
886 break;
887 case METER_NOTIFY_CAPPING:
888 sysfs_notify(&device->dev.kobj, NULL, POWER_ALARM_NAME);
889 dev_info(&device->dev, "Capping in progress.\n");
890 break;
891 default:
892 BUG();
893 }
894 mutex_unlock(&resource->lock);
895
896 acpi_bus_generate_netlink_event(ACPI_POWER_METER_CLASS,
897 dev_name(&device->dev), event, 0);
898}
899
900static int acpi_power_meter_add(struct acpi_device *device)
901{
902 int res;
903 struct acpi_power_meter_resource *resource;
904
905 if (!device)
906 return -EINVAL;
907
908 resource = kzalloc(sizeof(struct acpi_power_meter_resource),
909 GFP_KERNEL);
910 if (!resource)
911 return -ENOMEM;
912
913 resource->sensors_valid = 0;
914 resource->acpi_dev = device;
915 mutex_init(&resource->lock);
916 strcpy(acpi_device_name(device), ACPI_POWER_METER_DEVICE_NAME);
917 strcpy(acpi_device_class(device), ACPI_POWER_METER_CLASS);
918 device->driver_data = resource;
919
920 free_capabilities(resource);
921 res = read_capabilities(resource);
922 if (res)
923 goto exit_free;
924
925 resource->trip[0] = resource->trip[1] = -1;
926
927 res = setup_attrs(resource);
928 if (res)
929 goto exit_free;
930
931 resource->hwmon_dev = hwmon_device_register(&device->dev);
932 if (IS_ERR(resource->hwmon_dev)) {
933 res = PTR_ERR(resource->hwmon_dev);
934 goto exit_remove;
935 }
936
937 res = 0;
938 goto exit;
939
940exit_remove:
941 remove_attrs(resource);
942exit_free:
943 kfree(resource);
944exit:
945 return res;
946}
947
948static int acpi_power_meter_remove(struct acpi_device *device, int type)
949{
950 struct acpi_power_meter_resource *resource;
951
952 if (!device || !acpi_driver_data(device))
953 return -EINVAL;
954
955 resource = acpi_driver_data(device);
956 hwmon_device_unregister(resource->hwmon_dev);
957
958 free_capabilities(resource);
959 remove_attrs(resource);
960
961 kfree(resource);
962 return 0;
963}
964
965static int acpi_power_meter_resume(struct acpi_device *device)
966{
967 struct acpi_power_meter_resource *resource;
968
969 if (!device || !acpi_driver_data(device))
970 return -EINVAL;
971
972 resource = acpi_driver_data(device);
973 free_capabilities(resource);
974 read_capabilities(resource);
975
976 return 0;
977}
978
979static struct acpi_driver acpi_power_meter_driver = {
980 .name = "power_meter",
981 .class = ACPI_POWER_METER_CLASS,
982 .ids = power_meter_ids,
983 .ops = {
984 .add = acpi_power_meter_add,
985 .remove = acpi_power_meter_remove,
986 .resume = acpi_power_meter_resume,
987 .notify = acpi_power_meter_notify,
988 },
989};
990
991/* Module init/exit routines */
992static int __init enable_cap_knobs(const struct dmi_system_id *d)
993{
994 cap_in_hardware = 1;
995 return 0;
996}
997
998static struct dmi_system_id __initdata pm_dmi_table[] = {
999 {
1000 enable_cap_knobs, "IBM Active Energy Manager",
1001 {
1002 DMI_MATCH(DMI_SYS_VENDOR, "IBM")
1003 },
1004 },
1005 {}
1006};
1007
1008static int __init acpi_power_meter_init(void)
1009{
1010 int result;
1011
1012 if (acpi_disabled)
1013 return -ENODEV;
1014
1015 dmi_check_system(pm_dmi_table);
1016
1017 result = acpi_bus_register_driver(&acpi_power_meter_driver);
1018 if (result < 0)
1019 return -ENODEV;
1020
1021 return 0;
1022}
1023
1024static void __exit acpi_power_meter_exit(void)
1025{
1026 acpi_bus_unregister_driver(&acpi_power_meter_driver);
1027}
1028
1029MODULE_AUTHOR("Darrick J. Wong <djwong@us.ibm.com>");
1030MODULE_DESCRIPTION("ACPI 4.0 power meter driver");
1031MODULE_LICENSE("GPL");
1032
1033module_param(force_cap_on, bool, 0644);
1034MODULE_PARM_DESC(force_cap_on, "Enable power cap even it is unsafe to do so.");
1035
1036module_init(acpi_power_meter_init);
1037module_exit(acpi_power_meter_exit);