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