1 /*
2  * A hwmon driver for ACPI 4.0 power meters
3  * Copyright (C) 2009 IBM
4  *
5  * Author: Darrick J. Wong <darrick.wong@oracle.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>
28 #include <linux/slab.h>
29 #include <linux/kdev_t.h>
30 #include <linux/sched.h>
31 #include <linux/time.h>
32 #include <linux/err.h>
33 #include <linux/acpi.h>
34 
35 #define ACPI_POWER_METER_NAME		"power_meter"
36 ACPI_MODULE_NAME(ACPI_POWER_METER_NAME);
37 #define ACPI_POWER_METER_DEVICE_NAME	"Power Meter"
38 #define ACPI_POWER_METER_CLASS		"pwr_meter_resource"
39 
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 
60 static int cap_in_hardware;
61 static bool force_cap_on;
62 
63 static int can_cap_in_hardware(void)
64 {
65 	return force_cap_on || cap_in_hardware;
66 }
67 
68 static const struct acpi_device_id power_meter_ids[] = {
69 	{"ACPI000D", 0},
70 	{"", 0},
71 };
72 MODULE_DEVICE_TABLE(acpi, power_meter_ids);
73 
74 struct acpi_power_meter_capabilities {
75 	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;
86 };
87 
88 struct 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;
97 	u64		power;
98 	u64		cap;
99 	u64		avg_interval;
100 	int			sensors_valid;
101 	unsigned long		sensors_last_updated;
102 	struct sensor_device_attribute	sensors[NUM_SENSORS];
103 	int			num_sensors;
104 	s64			trip[2];
105 	int			num_domain_devices;
106 	struct acpi_device	**domain_devices;
107 	struct kobject		*holders_dir;
108 };
109 
110 struct sensor_template {
111 	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 */
122 static 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 
138 static 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 
152 static 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 
165 	res = kstrtoul(buf, 10, &temp);
166 	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 */
194 static 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 
210 static 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 
224 static 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 
236 	res = kstrtoul(buf, 10, &temp);
237 	if (res)
238 		return res;
239 
240 	temp = DIV_ROUND_CLOSEST(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 */
265 static 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 
290 	/* _PTP returns 0 on success, nonzero otherwise */
291 	if (data)
292 		return -EINVAL;
293 
294 	return 0;
295 }
296 
297 static 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 
306 	res = kstrtoul(buf, 10, &temp);
307 	if (res)
308 		return res;
309 
310 	temp = DIV_ROUND_CLOSEST(temp, 1000);
311 
312 	mutex_lock(&resource->lock);
313 	resource->trip[attr->index - 7] = temp;
314 	res = set_acpi_trip(resource);
315 	mutex_unlock(&resource->lock);
316 
317 	if (res)
318 		return res;
319 
320 	return count;
321 }
322 
323 /* Power meter */
324 static int update_meter(struct acpi_power_meter_resource *resource)
325 {
326 	unsigned long long data;
327 	acpi_status status;
328 	unsigned long local_jiffies = jiffies;
329 
330 	if (time_before(local_jiffies, resource->sensors_last_updated +
331 			msecs_to_jiffies(resource->caps.sampling_time)) &&
332 			resource->sensors_valid)
333 		return 0;
334 
335 	status = acpi_evaluate_integer(resource->acpi_dev->handle, "_PMM",
336 				       NULL, &data);
337 	if (ACPI_FAILURE(status)) {
338 		ACPI_EXCEPTION((AE_INFO, status, "Evaluating _PMM"));
339 		return -ENODEV;
340 	}
341 
342 	resource->power = data;
343 	resource->sensors_valid = 1;
344 	resource->sensors_last_updated = jiffies;
345 	return 0;
346 }
347 
348 static ssize_t show_power(struct device *dev,
349 			  struct device_attribute *devattr,
350 			  char *buf)
351 {
352 	struct acpi_device *acpi_dev = to_acpi_device(dev);
353 	struct acpi_power_meter_resource *resource = acpi_dev->driver_data;
354 
355 	mutex_lock(&resource->lock);
356 	update_meter(resource);
357 	mutex_unlock(&resource->lock);
358 
359 	return sprintf(buf, "%llu\n", resource->power * 1000);
360 }
361 
362 /* Miscellaneous */
363 static ssize_t show_str(struct device *dev,
364 			struct device_attribute *devattr,
365 			char *buf)
366 {
367 	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
368 	struct acpi_device *acpi_dev = to_acpi_device(dev);
369 	struct acpi_power_meter_resource *resource = acpi_dev->driver_data;
370 	acpi_string val;
371 
372 	switch (attr->index) {
373 	case 0:
374 		val = resource->model_number;
375 		break;
376 	case 1:
377 		val = resource->serial_number;
378 		break;
379 	case 2:
380 		val = resource->oem_info;
381 		break;
382 	default:
383 		WARN(1, "Implementation error: unexpected attribute index %d\n",
384 		     attr->index);
385 		val = "";
386 		break;
387 	}
388 
389 	return sprintf(buf, "%s\n", val);
390 }
391 
392 static 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;
399 	u64 val = 0;
400 
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 		WARN(1, "Implementation error: unexpected attribute index %d\n",
441 		     attr->index);
442 		break;
443 	}
444 
445 	return sprintf(buf, "%llu\n", val);
446 }
447 
448 static ssize_t show_accuracy(struct device *dev,
449 			     struct device_attribute *devattr,
450 			     char *buf)
451 {
452 	struct acpi_device *acpi_dev = to_acpi_device(dev);
453 	struct acpi_power_meter_resource *resource = acpi_dev->driver_data;
454 	unsigned int acc = resource->caps.accuracy;
455 
456 	return sprintf(buf, "%u.%u%%\n", acc / 1000, acc % 1000);
457 }
458 
459 static ssize_t show_name(struct device *dev,
460 			 struct device_attribute *devattr,
461 			 char *buf)
462 {
463 	return sprintf(buf, "%s\n", ACPI_POWER_METER_NAME);
464 }
465 
466 #define RO_SENSOR_TEMPLATE(_label, _show, _index)	\
467 	{						\
468 		.label = _label,			\
469 		.show  = _show,				\
470 		.index = _index,			\
471 	}
472 
473 #define RW_SENSOR_TEMPLATE(_label, _show, _set, _index)	\
474 	{						\
475 		.label = _label,			\
476 		.show  = _show,				\
477 		.set   = _set,				\
478 		.index = _index,			\
479 	}
480 
481 /* Sensor descriptions.  If you add a sensor, update NUM_SENSORS above! */
482 static struct sensor_template meter_attrs[] = {
483 	RO_SENSOR_TEMPLATE(POWER_AVERAGE_NAME, show_power, 0),
484 	RO_SENSOR_TEMPLATE("power1_accuracy", show_accuracy, 0),
485 	RO_SENSOR_TEMPLATE("power1_average_interval_min", show_val, 0),
486 	RO_SENSOR_TEMPLATE("power1_average_interval_max", show_val, 1),
487 	RO_SENSOR_TEMPLATE("power1_is_battery", show_val, 5),
488 	RW_SENSOR_TEMPLATE(POWER_AVG_INTERVAL_NAME, show_avg_interval,
489 		set_avg_interval, 0),
490 	{},
491 };
492 
493 static struct sensor_template misc_cap_attrs[] = {
494 	RO_SENSOR_TEMPLATE("power1_cap_min", show_val, 2),
495 	RO_SENSOR_TEMPLATE("power1_cap_max", show_val, 3),
496 	RO_SENSOR_TEMPLATE("power1_cap_hyst", show_val, 4),
497 	RO_SENSOR_TEMPLATE(POWER_ALARM_NAME, show_val, 6),
498 	{},
499 };
500 
501 static struct sensor_template ro_cap_attrs[] = {
502 	RO_SENSOR_TEMPLATE(POWER_CAP_NAME, show_cap, 0),
503 	{},
504 };
505 
506 static struct sensor_template rw_cap_attrs[] = {
507 	RW_SENSOR_TEMPLATE(POWER_CAP_NAME, show_cap, set_cap, 0),
508 	{},
509 };
510 
511 static struct sensor_template trip_attrs[] = {
512 	RW_SENSOR_TEMPLATE("power1_average_min", show_val, set_trip, 7),
513 	RW_SENSOR_TEMPLATE("power1_average_max", show_val, set_trip, 8),
514 	{},
515 };
516 
517 static struct sensor_template misc_attrs[] = {
518 	RO_SENSOR_TEMPLATE("name", show_name, 0),
519 	RO_SENSOR_TEMPLATE("power1_model_number", show_str, 0),
520 	RO_SENSOR_TEMPLATE("power1_oem_info", show_str, 2),
521 	RO_SENSOR_TEMPLATE("power1_serial_number", show_str, 1),
522 	{},
523 };
524 
525 #undef RO_SENSOR_TEMPLATE
526 #undef RW_SENSOR_TEMPLATE
527 
528 /* Read power domain data */
529 static void remove_domain_devices(struct acpi_power_meter_resource *resource)
530 {
531 	int i;
532 
533 	if (!resource->num_domain_devices)
534 		return;
535 
536 	for (i = 0; i < resource->num_domain_devices; i++) {
537 		struct acpi_device *obj = resource->domain_devices[i];
538 		if (!obj)
539 			continue;
540 
541 		sysfs_remove_link(resource->holders_dir,
542 				  kobject_name(&obj->dev.kobj));
543 		put_device(&obj->dev);
544 	}
545 
546 	kfree(resource->domain_devices);
547 	kobject_put(resource->holders_dir);
548 	resource->num_domain_devices = 0;
549 }
550 
551 static int read_domain_devices(struct acpi_power_meter_resource *resource)
552 {
553 	int res = 0;
554 	int i;
555 	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
556 	union acpi_object *pss;
557 	acpi_status status;
558 
559 	status = acpi_evaluate_object(resource->acpi_dev->handle, "_PMD", NULL,
560 				      &buffer);
561 	if (ACPI_FAILURE(status)) {
562 		ACPI_EXCEPTION((AE_INFO, status, "Evaluating _PMD"));
563 		return -ENODEV;
564 	}
565 
566 	pss = buffer.pointer;
567 	if (!pss ||
568 	    pss->type != ACPI_TYPE_PACKAGE) {
569 		dev_err(&resource->acpi_dev->dev, ACPI_POWER_METER_NAME
570 			"Invalid _PMD data\n");
571 		res = -EFAULT;
572 		goto end;
573 	}
574 
575 	if (!pss->package.count)
576 		goto end;
577 
578 	resource->domain_devices = kzalloc(sizeof(struct acpi_device *) *
579 					   pss->package.count, GFP_KERNEL);
580 	if (!resource->domain_devices) {
581 		res = -ENOMEM;
582 		goto end;
583 	}
584 
585 	resource->holders_dir = kobject_create_and_add("measures",
586 					&resource->acpi_dev->dev.kobj);
587 	if (!resource->holders_dir) {
588 		res = -ENOMEM;
589 		goto exit_free;
590 	}
591 
592 	resource->num_domain_devices = pss->package.count;
593 
594 	for (i = 0; i < pss->package.count; i++) {
595 		struct acpi_device *obj;
596 		union acpi_object *element = &(pss->package.elements[i]);
597 
598 		/* Refuse non-references */
599 		if (element->type != ACPI_TYPE_LOCAL_REFERENCE)
600 			continue;
601 
602 		/* Create a symlink to domain objects */
603 		resource->domain_devices[i] = NULL;
604 		if (acpi_bus_get_device(element->reference.handle,
605 					&resource->domain_devices[i]))
606 			continue;
607 
608 		obj = resource->domain_devices[i];
609 		get_device(&obj->dev);
610 
611 		res = sysfs_create_link(resource->holders_dir, &obj->dev.kobj,
612 				      kobject_name(&obj->dev.kobj));
613 		if (res) {
614 			put_device(&obj->dev);
615 			resource->domain_devices[i] = NULL;
616 		}
617 	}
618 
619 	res = 0;
620 	goto end;
621 
622 exit_free:
623 	kfree(resource->domain_devices);
624 end:
625 	kfree(buffer.pointer);
626 	return res;
627 }
628 
629 /* Registration and deregistration */
630 static int register_attrs(struct acpi_power_meter_resource *resource,
631 			  struct sensor_template *attrs)
632 {
633 	struct device *dev = &resource->acpi_dev->dev;
634 	struct sensor_device_attribute *sensors =
635 		&resource->sensors[resource->num_sensors];
636 	int res = 0;
637 
638 	while (attrs->label) {
639 		sensors->dev_attr.attr.name = attrs->label;
640 		sensors->dev_attr.attr.mode = S_IRUGO;
641 		sensors->dev_attr.show = attrs->show;
642 		sensors->index = attrs->index;
643 
644 		if (attrs->set) {
645 			sensors->dev_attr.attr.mode |= S_IWUSR;
646 			sensors->dev_attr.store = attrs->set;
647 		}
648 
649 		sysfs_attr_init(&sensors->dev_attr.attr);
650 		res = device_create_file(dev, &sensors->dev_attr);
651 		if (res) {
652 			sensors->dev_attr.attr.name = NULL;
653 			goto error;
654 		}
655 		sensors++;
656 		resource->num_sensors++;
657 		attrs++;
658 	}
659 
660 error:
661 	return res;
662 }
663 
664 static void remove_attrs(struct acpi_power_meter_resource *resource)
665 {
666 	int i;
667 
668 	for (i = 0; i < resource->num_sensors; i++) {
669 		if (!resource->sensors[i].dev_attr.attr.name)
670 			continue;
671 		device_remove_file(&resource->acpi_dev->dev,
672 				   &resource->sensors[i].dev_attr);
673 	}
674 
675 	remove_domain_devices(resource);
676 
677 	resource->num_sensors = 0;
678 }
679 
680 static int setup_attrs(struct acpi_power_meter_resource *resource)
681 {
682 	int res = 0;
683 
684 	res = read_domain_devices(resource);
685 	if (res)
686 		return res;
687 
688 	if (resource->caps.flags & POWER_METER_CAN_MEASURE) {
689 		res = register_attrs(resource, meter_attrs);
690 		if (res)
691 			goto error;
692 	}
693 
694 	if (resource->caps.flags & POWER_METER_CAN_CAP) {
695 		if (!can_cap_in_hardware()) {
696 			dev_err(&resource->acpi_dev->dev,
697 				"Ignoring unsafe software power cap!\n");
698 			goto skip_unsafe_cap;
699 		}
700 
701 		if (resource->caps.configurable_cap)
702 			res = register_attrs(resource, rw_cap_attrs);
703 		else
704 			res = register_attrs(resource, ro_cap_attrs);
705 
706 		if (res)
707 			goto error;
708 
709 		res = register_attrs(resource, misc_cap_attrs);
710 		if (res)
711 			goto error;
712 	}
713 
714 skip_unsafe_cap:
715 	if (resource->caps.flags & POWER_METER_CAN_TRIP) {
716 		res = register_attrs(resource, trip_attrs);
717 		if (res)
718 			goto error;
719 	}
720 
721 	res = register_attrs(resource, misc_attrs);
722 	if (res)
723 		goto error;
724 
725 	return res;
726 error:
727 	remove_attrs(resource);
728 	return res;
729 }
730 
731 static void free_capabilities(struct acpi_power_meter_resource *resource)
732 {
733 	acpi_string *str;
734 	int i;
735 
736 	str = &resource->model_number;
737 	for (i = 0; i < 3; i++, str++)
738 		kfree(*str);
739 }
740 
741 static int read_capabilities(struct acpi_power_meter_resource *resource)
742 {
743 	int res = 0;
744 	int i;
745 	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
746 	struct acpi_buffer state = { 0, NULL };
747 	struct acpi_buffer format = { sizeof("NNNNNNNNNNN"), "NNNNNNNNNNN" };
748 	union acpi_object *pss;
749 	acpi_string *str;
750 	acpi_status status;
751 
752 	status = acpi_evaluate_object(resource->acpi_dev->handle, "_PMC", NULL,
753 				      &buffer);
754 	if (ACPI_FAILURE(status)) {
755 		ACPI_EXCEPTION((AE_INFO, status, "Evaluating _PMC"));
756 		return -ENODEV;
757 	}
758 
759 	pss = buffer.pointer;
760 	if (!pss ||
761 	    pss->type != ACPI_TYPE_PACKAGE ||
762 	    pss->package.count != 14) {
763 		dev_err(&resource->acpi_dev->dev, ACPI_POWER_METER_NAME
764 			"Invalid _PMC data\n");
765 		res = -EFAULT;
766 		goto end;
767 	}
768 
769 	/* Grab all the integer data at once */
770 	state.length = sizeof(struct acpi_power_meter_capabilities);
771 	state.pointer = &resource->caps;
772 
773 	status = acpi_extract_package(pss, &format, &state);
774 	if (ACPI_FAILURE(status)) {
775 		ACPI_EXCEPTION((AE_INFO, status, "Invalid data"));
776 		res = -EFAULT;
777 		goto end;
778 	}
779 
780 	if (resource->caps.units) {
781 		dev_err(&resource->acpi_dev->dev, ACPI_POWER_METER_NAME
782 			"Unknown units %llu.\n",
783 			resource->caps.units);
784 		res = -EINVAL;
785 		goto end;
786 	}
787 
788 	/* Grab the string data */
789 	str = &resource->model_number;
790 
791 	for (i = 11; i < 14; i++) {
792 		union acpi_object *element = &(pss->package.elements[i]);
793 
794 		if (element->type != ACPI_TYPE_STRING) {
795 			res = -EINVAL;
796 			goto error;
797 		}
798 
799 		*str = kzalloc(sizeof(u8) * (element->string.length + 1),
800 			       GFP_KERNEL);
801 		if (!*str) {
802 			res = -ENOMEM;
803 			goto error;
804 		}
805 
806 		strncpy(*str, element->string.pointer, element->string.length);
807 		str++;
808 	}
809 
810 	dev_info(&resource->acpi_dev->dev, "Found ACPI power meter.\n");
811 	goto end;
812 error:
813 	str = &resource->model_number;
814 	for (i = 0; i < 3; i++, str++)
815 		kfree(*str);
816 end:
817 	kfree(buffer.pointer);
818 	return res;
819 }
820 
821 /* Handle ACPI event notifications */
822 static void acpi_power_meter_notify(struct acpi_device *device, u32 event)
823 {
824 	struct acpi_power_meter_resource *resource;
825 	int res;
826 
827 	if (!device || !acpi_driver_data(device))
828 		return;
829 
830 	resource = acpi_driver_data(device);
831 
832 	mutex_lock(&resource->lock);
833 	switch (event) {
834 	case METER_NOTIFY_CONFIG:
835 		free_capabilities(resource);
836 		res = read_capabilities(resource);
837 		if (res)
838 			break;
839 
840 		remove_attrs(resource);
841 		setup_attrs(resource);
842 		break;
843 	case METER_NOTIFY_TRIP:
844 		sysfs_notify(&device->dev.kobj, NULL, POWER_AVERAGE_NAME);
845 		update_meter(resource);
846 		break;
847 	case METER_NOTIFY_CAP:
848 		sysfs_notify(&device->dev.kobj, NULL, POWER_CAP_NAME);
849 		update_cap(resource);
850 		break;
851 	case METER_NOTIFY_INTERVAL:
852 		sysfs_notify(&device->dev.kobj, NULL, POWER_AVG_INTERVAL_NAME);
853 		update_avg_interval(resource);
854 		break;
855 	case METER_NOTIFY_CAPPING:
856 		sysfs_notify(&device->dev.kobj, NULL, POWER_ALARM_NAME);
857 		dev_info(&device->dev, "Capping in progress.\n");
858 		break;
859 	default:
860 		WARN(1, "Unexpected event %d\n", event);
861 		break;
862 	}
863 	mutex_unlock(&resource->lock);
864 
865 	acpi_bus_generate_netlink_event(ACPI_POWER_METER_CLASS,
866 					dev_name(&device->dev), event, 0);
867 }
868 
869 static int acpi_power_meter_add(struct acpi_device *device)
870 {
871 	int res;
872 	struct acpi_power_meter_resource *resource;
873 
874 	if (!device)
875 		return -EINVAL;
876 
877 	resource = kzalloc(sizeof(struct acpi_power_meter_resource),
878 			   GFP_KERNEL);
879 	if (!resource)
880 		return -ENOMEM;
881 
882 	resource->sensors_valid = 0;
883 	resource->acpi_dev = device;
884 	mutex_init(&resource->lock);
885 	strcpy(acpi_device_name(device), ACPI_POWER_METER_DEVICE_NAME);
886 	strcpy(acpi_device_class(device), ACPI_POWER_METER_CLASS);
887 	device->driver_data = resource;
888 
889 	free_capabilities(resource);
890 	res = read_capabilities(resource);
891 	if (res)
892 		goto exit_free;
893 
894 	resource->trip[0] = resource->trip[1] = -1;
895 
896 	res = setup_attrs(resource);
897 	if (res)
898 		goto exit_free;
899 
900 	resource->hwmon_dev = hwmon_device_register(&device->dev);
901 	if (IS_ERR(resource->hwmon_dev)) {
902 		res = PTR_ERR(resource->hwmon_dev);
903 		goto exit_remove;
904 	}
905 
906 	res = 0;
907 	goto exit;
908 
909 exit_remove:
910 	remove_attrs(resource);
911 exit_free:
912 	kfree(resource);
913 exit:
914 	return res;
915 }
916 
917 static int acpi_power_meter_remove(struct acpi_device *device)
918 {
919 	struct acpi_power_meter_resource *resource;
920 
921 	if (!device || !acpi_driver_data(device))
922 		return -EINVAL;
923 
924 	resource = acpi_driver_data(device);
925 	hwmon_device_unregister(resource->hwmon_dev);
926 
927 	free_capabilities(resource);
928 	remove_attrs(resource);
929 
930 	kfree(resource);
931 	return 0;
932 }
933 
934 #ifdef CONFIG_PM_SLEEP
935 
936 static int acpi_power_meter_resume(struct device *dev)
937 {
938 	struct acpi_power_meter_resource *resource;
939 
940 	if (!dev)
941 		return -EINVAL;
942 
943 	resource = acpi_driver_data(to_acpi_device(dev));
944 	if (!resource)
945 		return -EINVAL;
946 
947 	free_capabilities(resource);
948 	read_capabilities(resource);
949 
950 	return 0;
951 }
952 
953 #endif /* CONFIG_PM_SLEEP */
954 
955 static SIMPLE_DEV_PM_OPS(acpi_power_meter_pm, NULL, acpi_power_meter_resume);
956 
957 static struct acpi_driver acpi_power_meter_driver = {
958 	.name = "power_meter",
959 	.class = ACPI_POWER_METER_CLASS,
960 	.ids = power_meter_ids,
961 	.ops = {
962 		.add = acpi_power_meter_add,
963 		.remove = acpi_power_meter_remove,
964 		.notify = acpi_power_meter_notify,
965 		},
966 	.drv.pm = &acpi_power_meter_pm,
967 };
968 
969 /* Module init/exit routines */
970 static int __init enable_cap_knobs(const struct dmi_system_id *d)
971 {
972 	cap_in_hardware = 1;
973 	return 0;
974 }
975 
976 static const struct dmi_system_id pm_dmi_table[] __initconst = {
977 	{
978 		enable_cap_knobs, "IBM Active Energy Manager",
979 		{
980 			DMI_MATCH(DMI_SYS_VENDOR, "IBM")
981 		},
982 	},
983 	{}
984 };
985 
986 static int __init acpi_power_meter_init(void)
987 {
988 	int result;
989 
990 	if (acpi_disabled)
991 		return -ENODEV;
992 
993 	dmi_check_system(pm_dmi_table);
994 
995 	result = acpi_bus_register_driver(&acpi_power_meter_driver);
996 	if (result < 0)
997 		return result;
998 
999 	return 0;
1000 }
1001 
1002 static void __exit acpi_power_meter_exit(void)
1003 {
1004 	acpi_bus_unregister_driver(&acpi_power_meter_driver);
1005 }
1006 
1007 MODULE_AUTHOR("Darrick J. Wong <darrick.wong@oracle.com>");
1008 MODULE_DESCRIPTION("ACPI 4.0 power meter driver");
1009 MODULE_LICENSE("GPL");
1010 
1011 module_param(force_cap_on, bool, 0644);
1012 MODULE_PARM_DESC(force_cap_on, "Enable power cap even it is unsafe to do so.");
1013 
1014 module_init(acpi_power_meter_init);
1015 module_exit(acpi_power_meter_exit);
1016