xref: /openbmc/linux/drivers/hwmon/acpi_power_meter.c (revision d0c44de2d8ffd2e4780d360b34ee6614aa4af080)
11a59d1b8SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later
27d033365SJean Delvare /*
37d033365SJean Delvare  * A hwmon driver for ACPI 4.0 power meters
47d033365SJean Delvare  * Copyright (C) 2009 IBM
57d033365SJean Delvare  *
65407e051SDarrick J. Wong  * Author: Darrick J. Wong <darrick.wong@oracle.com>
77d033365SJean Delvare  */
87d033365SJean Delvare 
97d033365SJean Delvare #include <linux/module.h>
107d033365SJean Delvare #include <linux/hwmon.h>
117d033365SJean Delvare #include <linux/hwmon-sysfs.h>
127d033365SJean Delvare #include <linux/jiffies.h>
137d033365SJean Delvare #include <linux/mutex.h>
147d033365SJean Delvare #include <linux/dmi.h>
157d033365SJean Delvare #include <linux/slab.h>
167d033365SJean Delvare #include <linux/kdev_t.h>
177d033365SJean Delvare #include <linux/sched.h>
187d033365SJean Delvare #include <linux/time.h>
19fa845740SJean Delvare #include <linux/err.h>
208b48463fSLv Zheng #include <linux/acpi.h>
217d033365SJean Delvare 
227d033365SJean Delvare #define ACPI_POWER_METER_NAME		"power_meter"
237d033365SJean Delvare #define ACPI_POWER_METER_DEVICE_NAME	"Power Meter"
247d033365SJean Delvare #define ACPI_POWER_METER_CLASS		"pwr_meter_resource"
257d033365SJean Delvare 
267d033365SJean Delvare #define NUM_SENSORS			17
277d033365SJean Delvare 
287d033365SJean Delvare #define POWER_METER_CAN_MEASURE	(1 << 0)
297d033365SJean Delvare #define POWER_METER_CAN_TRIP	(1 << 1)
307d033365SJean Delvare #define POWER_METER_CAN_CAP	(1 << 2)
317d033365SJean Delvare #define POWER_METER_CAN_NOTIFY	(1 << 3)
327d033365SJean Delvare #define POWER_METER_IS_BATTERY	(1 << 8)
337d033365SJean Delvare #define UNKNOWN_HYSTERESIS	0xFFFFFFFF
34*8ebf0590SArmin Wolf #define UNKNOWN_POWER		0xFFFFFFFF
357d033365SJean Delvare 
367d033365SJean Delvare #define METER_NOTIFY_CONFIG	0x80
377d033365SJean Delvare #define METER_NOTIFY_TRIP	0x81
387d033365SJean Delvare #define METER_NOTIFY_CAP	0x82
397d033365SJean Delvare #define METER_NOTIFY_CAPPING	0x83
407d033365SJean Delvare #define METER_NOTIFY_INTERVAL	0x84
417d033365SJean Delvare 
427d033365SJean Delvare #define POWER_AVERAGE_NAME	"power1_average"
437d033365SJean Delvare #define POWER_CAP_NAME		"power1_cap"
447d033365SJean Delvare #define POWER_AVG_INTERVAL_NAME	"power1_average_interval"
457d033365SJean Delvare #define POWER_ALARM_NAME	"power1_alarm"
467d033365SJean Delvare 
477d033365SJean Delvare static int cap_in_hardware;
4890ab5ee9SRusty Russell static bool force_cap_on;
497d033365SJean Delvare 
can_cap_in_hardware(void)507d033365SJean Delvare static int can_cap_in_hardware(void)
517d033365SJean Delvare {
527d033365SJean Delvare 	return force_cap_on || cap_in_hardware;
537d033365SJean Delvare }
547d033365SJean Delvare 
557d033365SJean Delvare static const struct acpi_device_id power_meter_ids[] = {
567d033365SJean Delvare 	{"ACPI000D", 0},
577d033365SJean Delvare 	{"", 0},
587d033365SJean Delvare };
597d033365SJean Delvare MODULE_DEVICE_TABLE(acpi, power_meter_ids);
607d033365SJean Delvare 
617d033365SJean Delvare struct acpi_power_meter_capabilities {
627d033365SJean Delvare 	u64		flags;
637d033365SJean Delvare 	u64		units;
647d033365SJean Delvare 	u64		type;
657d033365SJean Delvare 	u64		accuracy;
667d033365SJean Delvare 	u64		sampling_time;
677d033365SJean Delvare 	u64		min_avg_interval;
687d033365SJean Delvare 	u64		max_avg_interval;
697d033365SJean Delvare 	u64		hysteresis;
707d033365SJean Delvare 	u64		configurable_cap;
717d033365SJean Delvare 	u64		min_cap;
727d033365SJean Delvare 	u64		max_cap;
737d033365SJean Delvare };
747d033365SJean Delvare 
757d033365SJean Delvare struct acpi_power_meter_resource {
767d033365SJean Delvare 	struct acpi_device	*acpi_dev;
777d033365SJean Delvare 	acpi_bus_id		name;
787d033365SJean Delvare 	struct mutex		lock;
797d033365SJean Delvare 	struct device		*hwmon_dev;
807d033365SJean Delvare 	struct acpi_power_meter_capabilities	caps;
817d033365SJean Delvare 	acpi_string		model_number;
827d033365SJean Delvare 	acpi_string		serial_number;
837d033365SJean Delvare 	acpi_string		oem_info;
847d033365SJean Delvare 	u64		power;
857d033365SJean Delvare 	u64		cap;
867d033365SJean Delvare 	u64		avg_interval;
877d033365SJean Delvare 	int			sensors_valid;
887d033365SJean Delvare 	unsigned long		sensors_last_updated;
897d033365SJean Delvare 	struct sensor_device_attribute	sensors[NUM_SENSORS];
907d033365SJean Delvare 	int			num_sensors;
9175311beaSGuenter Roeck 	s64			trip[2];
927d033365SJean Delvare 	int			num_domain_devices;
937d033365SJean Delvare 	struct acpi_device	**domain_devices;
947d033365SJean Delvare 	struct kobject		*holders_dir;
957d033365SJean Delvare };
967d033365SJean Delvare 
9781194cd2SKyle McMartin struct sensor_template {
987d033365SJean Delvare 	char *label;
997d033365SJean Delvare 	ssize_t (*show)(struct device *dev,
1007d033365SJean Delvare 			struct device_attribute *devattr,
1017d033365SJean Delvare 			char *buf);
1027d033365SJean Delvare 	ssize_t (*set)(struct device *dev,
1037d033365SJean Delvare 		       struct device_attribute *devattr,
1047d033365SJean Delvare 		       const char *buf, size_t count);
1057d033365SJean Delvare 	int index;
1067d033365SJean Delvare };
1077d033365SJean Delvare 
1087d033365SJean Delvare /* Averaging interval */
update_avg_interval(struct acpi_power_meter_resource * resource)1097d033365SJean Delvare static int update_avg_interval(struct acpi_power_meter_resource *resource)
1107d033365SJean Delvare {
1117d033365SJean Delvare 	unsigned long long data;
1127d033365SJean Delvare 	acpi_status status;
1137d033365SJean Delvare 
1147d033365SJean Delvare 	status = acpi_evaluate_integer(resource->acpi_dev->handle, "_GAI",
1157d033365SJean Delvare 				       NULL, &data);
1167d033365SJean Delvare 	if (ACPI_FAILURE(status)) {
117ebf1bef3SRafael J. Wysocki 		acpi_evaluation_failure_warn(resource->acpi_dev->handle, "_GAI",
118ebf1bef3SRafael J. Wysocki 					     status);
1197d033365SJean Delvare 		return -ENODEV;
1207d033365SJean Delvare 	}
1217d033365SJean Delvare 
1227d033365SJean Delvare 	resource->avg_interval = data;
1237d033365SJean Delvare 	return 0;
1247d033365SJean Delvare }
1257d033365SJean Delvare 
show_avg_interval(struct device * dev,struct device_attribute * devattr,char * buf)1267d033365SJean Delvare static ssize_t show_avg_interval(struct device *dev,
1277d033365SJean Delvare 				 struct device_attribute *devattr,
1287d033365SJean Delvare 				 char *buf)
1297d033365SJean Delvare {
1307d033365SJean Delvare 	struct acpi_device *acpi_dev = to_acpi_device(dev);
1317d033365SJean Delvare 	struct acpi_power_meter_resource *resource = acpi_dev->driver_data;
1327d033365SJean Delvare 
1337d033365SJean Delvare 	mutex_lock(&resource->lock);
1347d033365SJean Delvare 	update_avg_interval(resource);
1357d033365SJean Delvare 	mutex_unlock(&resource->lock);
1367d033365SJean Delvare 
1377d033365SJean Delvare 	return sprintf(buf, "%llu\n", resource->avg_interval);
1387d033365SJean Delvare }
1397d033365SJean Delvare 
set_avg_interval(struct device * dev,struct device_attribute * devattr,const char * buf,size_t count)1407d033365SJean Delvare static ssize_t set_avg_interval(struct device *dev,
1417d033365SJean Delvare 				struct device_attribute *devattr,
1427d033365SJean Delvare 				const char *buf, size_t count)
1437d033365SJean Delvare {
1447d033365SJean Delvare 	struct acpi_device *acpi_dev = to_acpi_device(dev);
1457d033365SJean Delvare 	struct acpi_power_meter_resource *resource = acpi_dev->driver_data;
1467d033365SJean Delvare 	union acpi_object arg0 = { ACPI_TYPE_INTEGER };
1477d033365SJean Delvare 	struct acpi_object_list args = { 1, &arg0 };
1487d033365SJean Delvare 	int res;
1497d033365SJean Delvare 	unsigned long temp;
1507d033365SJean Delvare 	unsigned long long data;
1517d033365SJean Delvare 	acpi_status status;
1527d033365SJean Delvare 
153179c4fdbSFrans Meulenbroeks 	res = kstrtoul(buf, 10, &temp);
1547d033365SJean Delvare 	if (res)
1557d033365SJean Delvare 		return res;
1567d033365SJean Delvare 
1577d033365SJean Delvare 	if (temp > resource->caps.max_avg_interval ||
1587d033365SJean Delvare 	    temp < resource->caps.min_avg_interval)
1597d033365SJean Delvare 		return -EINVAL;
1607d033365SJean Delvare 	arg0.integer.value = temp;
1617d033365SJean Delvare 
1627d033365SJean Delvare 	mutex_lock(&resource->lock);
1637d033365SJean Delvare 	status = acpi_evaluate_integer(resource->acpi_dev->handle, "_PAI",
1647d033365SJean Delvare 				       &args, &data);
16510e92724SBjorn Helgaas 	if (ACPI_SUCCESS(status))
1667d033365SJean Delvare 		resource->avg_interval = temp;
1677d033365SJean Delvare 	mutex_unlock(&resource->lock);
1687d033365SJean Delvare 
1697d033365SJean Delvare 	if (ACPI_FAILURE(status)) {
170ebf1bef3SRafael J. Wysocki 		acpi_evaluation_failure_warn(resource->acpi_dev->handle, "_PAI",
171ebf1bef3SRafael J. Wysocki 					     status);
1727d033365SJean Delvare 		return -EINVAL;
1737d033365SJean Delvare 	}
1747d033365SJean Delvare 
1757d033365SJean Delvare 	/* _PAI returns 0 on success, nonzero otherwise */
1767d033365SJean Delvare 	if (data)
1777d033365SJean Delvare 		return -EINVAL;
1787d033365SJean Delvare 
1797d033365SJean Delvare 	return count;
1807d033365SJean Delvare }
1817d033365SJean Delvare 
1827d033365SJean Delvare /* Cap functions */
update_cap(struct acpi_power_meter_resource * resource)1837d033365SJean Delvare static int update_cap(struct acpi_power_meter_resource *resource)
1847d033365SJean Delvare {
1857d033365SJean Delvare 	unsigned long long data;
1867d033365SJean Delvare 	acpi_status status;
1877d033365SJean Delvare 
1887d033365SJean Delvare 	status = acpi_evaluate_integer(resource->acpi_dev->handle, "_GHL",
1897d033365SJean Delvare 				       NULL, &data);
1907d033365SJean Delvare 	if (ACPI_FAILURE(status)) {
191ebf1bef3SRafael J. Wysocki 		acpi_evaluation_failure_warn(resource->acpi_dev->handle, "_GHL",
192ebf1bef3SRafael J. Wysocki 					     status);
1937d033365SJean Delvare 		return -ENODEV;
1947d033365SJean Delvare 	}
1957d033365SJean Delvare 
1967d033365SJean Delvare 	resource->cap = data;
1977d033365SJean Delvare 	return 0;
1987d033365SJean Delvare }
1997d033365SJean Delvare 
show_cap(struct device * dev,struct device_attribute * devattr,char * buf)2007d033365SJean Delvare static ssize_t show_cap(struct device *dev,
2017d033365SJean Delvare 			struct device_attribute *devattr,
2027d033365SJean Delvare 			char *buf)
2037d033365SJean Delvare {
2047d033365SJean Delvare 	struct acpi_device *acpi_dev = to_acpi_device(dev);
2057d033365SJean Delvare 	struct acpi_power_meter_resource *resource = acpi_dev->driver_data;
2067d033365SJean Delvare 
2077d033365SJean Delvare 	mutex_lock(&resource->lock);
2087d033365SJean Delvare 	update_cap(resource);
2097d033365SJean Delvare 	mutex_unlock(&resource->lock);
2107d033365SJean Delvare 
2117d033365SJean Delvare 	return sprintf(buf, "%llu\n", resource->cap * 1000);
2127d033365SJean Delvare }
2137d033365SJean Delvare 
set_cap(struct device * dev,struct device_attribute * devattr,const char * buf,size_t count)2147d033365SJean Delvare static ssize_t set_cap(struct device *dev, struct device_attribute *devattr,
2157d033365SJean Delvare 		       const char *buf, size_t count)
2167d033365SJean Delvare {
2177d033365SJean Delvare 	struct acpi_device *acpi_dev = to_acpi_device(dev);
2187d033365SJean Delvare 	struct acpi_power_meter_resource *resource = acpi_dev->driver_data;
2197d033365SJean Delvare 	union acpi_object arg0 = { ACPI_TYPE_INTEGER };
2207d033365SJean Delvare 	struct acpi_object_list args = { 1, &arg0 };
2217d033365SJean Delvare 	int res;
2227d033365SJean Delvare 	unsigned long temp;
2237d033365SJean Delvare 	unsigned long long data;
2247d033365SJean Delvare 	acpi_status status;
2257d033365SJean Delvare 
226179c4fdbSFrans Meulenbroeks 	res = kstrtoul(buf, 10, &temp);
2277d033365SJean Delvare 	if (res)
2287d033365SJean Delvare 		return res;
2297d033365SJean Delvare 
23027c4db39SGuenter Roeck 	temp = DIV_ROUND_CLOSEST(temp, 1000);
2317d033365SJean Delvare 	if (temp > resource->caps.max_cap || temp < resource->caps.min_cap)
2327d033365SJean Delvare 		return -EINVAL;
2337d033365SJean Delvare 	arg0.integer.value = temp;
2347d033365SJean Delvare 
2357d033365SJean Delvare 	mutex_lock(&resource->lock);
2367d033365SJean Delvare 	status = acpi_evaluate_integer(resource->acpi_dev->handle, "_SHL",
2377d033365SJean Delvare 				       &args, &data);
23810e92724SBjorn Helgaas 	if (ACPI_SUCCESS(status))
2397d033365SJean Delvare 		resource->cap = temp;
2407d033365SJean Delvare 	mutex_unlock(&resource->lock);
2417d033365SJean Delvare 
2427d033365SJean Delvare 	if (ACPI_FAILURE(status)) {
243ebf1bef3SRafael J. Wysocki 		acpi_evaluation_failure_warn(resource->acpi_dev->handle, "_SHL",
244ebf1bef3SRafael J. Wysocki 					     status);
2457d033365SJean Delvare 		return -EINVAL;
2467d033365SJean Delvare 	}
2477d033365SJean Delvare 
2487d033365SJean Delvare 	/* _SHL returns 0 on success, nonzero otherwise */
2497d033365SJean Delvare 	if (data)
2507d033365SJean Delvare 		return -EINVAL;
2517d033365SJean Delvare 
2527d033365SJean Delvare 	return count;
2537d033365SJean Delvare }
2547d033365SJean Delvare 
2557d033365SJean Delvare /* Power meter trip points */
set_acpi_trip(struct acpi_power_meter_resource * resource)2567d033365SJean Delvare static int set_acpi_trip(struct acpi_power_meter_resource *resource)
2577d033365SJean Delvare {
2587d033365SJean Delvare 	union acpi_object arg_objs[] = {
2597d033365SJean Delvare 		{ACPI_TYPE_INTEGER},
2607d033365SJean Delvare 		{ACPI_TYPE_INTEGER}
2617d033365SJean Delvare 	};
2627d033365SJean Delvare 	struct acpi_object_list args = { 2, arg_objs };
2637d033365SJean Delvare 	unsigned long long data;
2647d033365SJean Delvare 	acpi_status status;
2657d033365SJean Delvare 
2667d033365SJean Delvare 	/* Both trip levels must be set */
2677d033365SJean Delvare 	if (resource->trip[0] < 0 || resource->trip[1] < 0)
2687d033365SJean Delvare 		return 0;
2697d033365SJean Delvare 
2707d033365SJean Delvare 	/* This driver stores min, max; ACPI wants max, min. */
2717d033365SJean Delvare 	arg_objs[0].integer.value = resource->trip[1];
2727d033365SJean Delvare 	arg_objs[1].integer.value = resource->trip[0];
2737d033365SJean Delvare 
2747d033365SJean Delvare 	status = acpi_evaluate_integer(resource->acpi_dev->handle, "_PTP",
2757d033365SJean Delvare 				       &args, &data);
2767d033365SJean Delvare 	if (ACPI_FAILURE(status)) {
277ebf1bef3SRafael J. Wysocki 		acpi_evaluation_failure_warn(resource->acpi_dev->handle, "_PTP",
278ebf1bef3SRafael J. Wysocki 					     status);
2797d033365SJean Delvare 		return -EINVAL;
2807d033365SJean Delvare 	}
2817d033365SJean Delvare 
2827d033365SJean Delvare 	/* _PTP returns 0 on success, nonzero otherwise */
2837d033365SJean Delvare 	if (data)
2847d033365SJean Delvare 		return -EINVAL;
2857d033365SJean Delvare 
2867d033365SJean Delvare 	return 0;
2877d033365SJean Delvare }
2887d033365SJean Delvare 
set_trip(struct device * dev,struct device_attribute * devattr,const char * buf,size_t count)2897d033365SJean Delvare static ssize_t set_trip(struct device *dev, struct device_attribute *devattr,
2907d033365SJean Delvare 			const char *buf, size_t count)
2917d033365SJean Delvare {
2927d033365SJean Delvare 	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
2937d033365SJean Delvare 	struct acpi_device *acpi_dev = to_acpi_device(dev);
2947d033365SJean Delvare 	struct acpi_power_meter_resource *resource = acpi_dev->driver_data;
2957d033365SJean Delvare 	int res;
2967d033365SJean Delvare 	unsigned long temp;
2977d033365SJean Delvare 
298179c4fdbSFrans Meulenbroeks 	res = kstrtoul(buf, 10, &temp);
2997d033365SJean Delvare 	if (res)
3007d033365SJean Delvare 		return res;
3017d033365SJean Delvare 
30227c4db39SGuenter Roeck 	temp = DIV_ROUND_CLOSEST(temp, 1000);
3037d033365SJean Delvare 
3047d033365SJean Delvare 	mutex_lock(&resource->lock);
3057d033365SJean Delvare 	resource->trip[attr->index - 7] = temp;
3067d033365SJean Delvare 	res = set_acpi_trip(resource);
3077d033365SJean Delvare 	mutex_unlock(&resource->lock);
3087d033365SJean Delvare 
3097d033365SJean Delvare 	if (res)
3107d033365SJean Delvare 		return res;
3117d033365SJean Delvare 
3127d033365SJean Delvare 	return count;
3137d033365SJean Delvare }
3147d033365SJean Delvare 
3157d033365SJean Delvare /* Power meter */
update_meter(struct acpi_power_meter_resource * resource)3167d033365SJean Delvare static int update_meter(struct acpi_power_meter_resource *resource)
3177d033365SJean Delvare {
3187d033365SJean Delvare 	unsigned long long data;
3197d033365SJean Delvare 	acpi_status status;
3207d033365SJean Delvare 	unsigned long local_jiffies = jiffies;
3217d033365SJean Delvare 
3227d033365SJean Delvare 	if (time_before(local_jiffies, resource->sensors_last_updated +
3237d033365SJean Delvare 			msecs_to_jiffies(resource->caps.sampling_time)) &&
3247d033365SJean Delvare 			resource->sensors_valid)
3257d033365SJean Delvare 		return 0;
3267d033365SJean Delvare 
3277d033365SJean Delvare 	status = acpi_evaluate_integer(resource->acpi_dev->handle, "_PMM",
3287d033365SJean Delvare 				       NULL, &data);
3297d033365SJean Delvare 	if (ACPI_FAILURE(status)) {
330ebf1bef3SRafael J. Wysocki 		acpi_evaluation_failure_warn(resource->acpi_dev->handle, "_PMM",
331ebf1bef3SRafael J. Wysocki 					     status);
3327d033365SJean Delvare 		return -ENODEV;
3337d033365SJean Delvare 	}
3347d033365SJean Delvare 
3357d033365SJean Delvare 	resource->power = data;
3367d033365SJean Delvare 	resource->sensors_valid = 1;
3377d033365SJean Delvare 	resource->sensors_last_updated = jiffies;
3387d033365SJean Delvare 	return 0;
3397d033365SJean Delvare }
3407d033365SJean Delvare 
show_power(struct device * dev,struct device_attribute * devattr,char * buf)3417d033365SJean Delvare static ssize_t show_power(struct device *dev,
3427d033365SJean Delvare 			  struct device_attribute *devattr,
3437d033365SJean Delvare 			  char *buf)
3447d033365SJean Delvare {
3457d033365SJean Delvare 	struct acpi_device *acpi_dev = to_acpi_device(dev);
3467d033365SJean Delvare 	struct acpi_power_meter_resource *resource = acpi_dev->driver_data;
3477d033365SJean Delvare 
3487d033365SJean Delvare 	mutex_lock(&resource->lock);
3497d033365SJean Delvare 	update_meter(resource);
3507d033365SJean Delvare 	mutex_unlock(&resource->lock);
3517d033365SJean Delvare 
352*8ebf0590SArmin Wolf 	if (resource->power == UNKNOWN_POWER)
353*8ebf0590SArmin Wolf 		return -ENODATA;
354*8ebf0590SArmin Wolf 
3557d033365SJean Delvare 	return sprintf(buf, "%llu\n", resource->power * 1000);
3567d033365SJean Delvare }
3577d033365SJean Delvare 
3587d033365SJean Delvare /* Miscellaneous */
show_str(struct device * dev,struct device_attribute * devattr,char * buf)3597d033365SJean Delvare static ssize_t show_str(struct device *dev,
3607d033365SJean Delvare 			struct device_attribute *devattr,
3617d033365SJean Delvare 			char *buf)
3627d033365SJean Delvare {
3637d033365SJean Delvare 	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
3647d033365SJean Delvare 	struct acpi_device *acpi_dev = to_acpi_device(dev);
3657d033365SJean Delvare 	struct acpi_power_meter_resource *resource = acpi_dev->driver_data;
3667d033365SJean Delvare 	acpi_string val;
367badcd454SGuenter Roeck 	int ret;
3687d033365SJean Delvare 
369badcd454SGuenter Roeck 	mutex_lock(&resource->lock);
3707d033365SJean Delvare 	switch (attr->index) {
3717d033365SJean Delvare 	case 0:
3727d033365SJean Delvare 		val = resource->model_number;
3737d033365SJean Delvare 		break;
3747d033365SJean Delvare 	case 1:
3757d033365SJean Delvare 		val = resource->serial_number;
3767d033365SJean Delvare 		break;
3777d033365SJean Delvare 	case 2:
3787d033365SJean Delvare 		val = resource->oem_info;
3797d033365SJean Delvare 		break;
3807d033365SJean Delvare 	default:
38183c97fe1SGuenter Roeck 		WARN(1, "Implementation error: unexpected attribute index %d\n",
38283c97fe1SGuenter Roeck 		     attr->index);
383776cdc11SGuenter Roeck 		val = "";
38483c97fe1SGuenter Roeck 		break;
3857d033365SJean Delvare 	}
386badcd454SGuenter Roeck 	ret = sprintf(buf, "%s\n", val);
387badcd454SGuenter Roeck 	mutex_unlock(&resource->lock);
388badcd454SGuenter Roeck 	return ret;
3897d033365SJean Delvare }
3907d033365SJean Delvare 
show_val(struct device * dev,struct device_attribute * devattr,char * buf)3917d033365SJean Delvare static ssize_t show_val(struct device *dev,
3927d033365SJean Delvare 			struct device_attribute *devattr,
3937d033365SJean Delvare 			char *buf)
3947d033365SJean Delvare {
3957d033365SJean Delvare 	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
3967d033365SJean Delvare 	struct acpi_device *acpi_dev = to_acpi_device(dev);
3977d033365SJean Delvare 	struct acpi_power_meter_resource *resource = acpi_dev->driver_data;
3987d033365SJean Delvare 	u64 val = 0;
3997d033365SJean Delvare 
4007d033365SJean Delvare 	switch (attr->index) {
4017d033365SJean Delvare 	case 0:
4027d033365SJean Delvare 		val = resource->caps.min_avg_interval;
4037d033365SJean Delvare 		break;
4047d033365SJean Delvare 	case 1:
4057d033365SJean Delvare 		val = resource->caps.max_avg_interval;
4067d033365SJean Delvare 		break;
4077d033365SJean Delvare 	case 2:
4087d033365SJean Delvare 		val = resource->caps.min_cap * 1000;
4097d033365SJean Delvare 		break;
4107d033365SJean Delvare 	case 3:
4117d033365SJean Delvare 		val = resource->caps.max_cap * 1000;
4127d033365SJean Delvare 		break;
4137d033365SJean Delvare 	case 4:
4147d033365SJean Delvare 		if (resource->caps.hysteresis == UNKNOWN_HYSTERESIS)
4157d033365SJean Delvare 			return sprintf(buf, "unknown\n");
4167d033365SJean Delvare 
4177d033365SJean Delvare 		val = resource->caps.hysteresis * 1000;
4187d033365SJean Delvare 		break;
4197d033365SJean Delvare 	case 5:
4207d033365SJean Delvare 		if (resource->caps.flags & POWER_METER_IS_BATTERY)
4217d033365SJean Delvare 			val = 1;
4227d033365SJean Delvare 		else
4237d033365SJean Delvare 			val = 0;
4247d033365SJean Delvare 		break;
4257d033365SJean Delvare 	case 6:
4267d033365SJean Delvare 		if (resource->power > resource->cap)
4277d033365SJean Delvare 			val = 1;
4287d033365SJean Delvare 		else
4297d033365SJean Delvare 			val = 0;
4307d033365SJean Delvare 		break;
4317d033365SJean Delvare 	case 7:
4327d033365SJean Delvare 	case 8:
4337d033365SJean Delvare 		if (resource->trip[attr->index - 7] < 0)
4347d033365SJean Delvare 			return sprintf(buf, "unknown\n");
4357d033365SJean Delvare 
4367d033365SJean Delvare 		val = resource->trip[attr->index - 7] * 1000;
4377d033365SJean Delvare 		break;
4387d033365SJean Delvare 	default:
43983c97fe1SGuenter Roeck 		WARN(1, "Implementation error: unexpected attribute index %d\n",
44083c97fe1SGuenter Roeck 		     attr->index);
44183c97fe1SGuenter Roeck 		break;
4427d033365SJean Delvare 	}
4437d033365SJean Delvare 
4447d033365SJean Delvare 	return sprintf(buf, "%llu\n", val);
4457d033365SJean Delvare }
4467d033365SJean Delvare 
show_accuracy(struct device * dev,struct device_attribute * devattr,char * buf)4477d033365SJean Delvare static ssize_t show_accuracy(struct device *dev,
4487d033365SJean Delvare 			     struct device_attribute *devattr,
4497d033365SJean Delvare 			     char *buf)
4507d033365SJean Delvare {
4517d033365SJean Delvare 	struct acpi_device *acpi_dev = to_acpi_device(dev);
4527d033365SJean Delvare 	struct acpi_power_meter_resource *resource = acpi_dev->driver_data;
4537d033365SJean Delvare 	unsigned int acc = resource->caps.accuracy;
4547d033365SJean Delvare 
4557d033365SJean Delvare 	return sprintf(buf, "%u.%u%%\n", acc / 1000, acc % 1000);
4567d033365SJean Delvare }
4577d033365SJean Delvare 
show_name(struct device * dev,struct device_attribute * devattr,char * buf)4587d033365SJean Delvare static ssize_t show_name(struct device *dev,
4597d033365SJean Delvare 			 struct device_attribute *devattr,
4607d033365SJean Delvare 			 char *buf)
4617d033365SJean Delvare {
4627d033365SJean Delvare 	return sprintf(buf, "%s\n", ACPI_POWER_METER_NAME);
4637d033365SJean Delvare }
4647d033365SJean Delvare 
4653c45f2c7SKyle McMartin #define RO_SENSOR_TEMPLATE(_label, _show, _index)	\
4663c45f2c7SKyle McMartin 	{						\
4673c45f2c7SKyle McMartin 		.label = _label,			\
4683c45f2c7SKyle McMartin 		.show  = _show,				\
4693c45f2c7SKyle McMartin 		.index = _index,			\
4703c45f2c7SKyle McMartin 	}
4713c45f2c7SKyle McMartin 
4723c45f2c7SKyle McMartin #define RW_SENSOR_TEMPLATE(_label, _show, _set, _index)	\
4733c45f2c7SKyle McMartin 	{						\
4743c45f2c7SKyle McMartin 		.label = _label,			\
4753c45f2c7SKyle McMartin 		.show  = _show,				\
4763c45f2c7SKyle McMartin 		.set   = _set,				\
4773c45f2c7SKyle McMartin 		.index = _index,			\
4783c45f2c7SKyle McMartin 	}
4793c45f2c7SKyle McMartin 
4807d033365SJean Delvare /* Sensor descriptions.  If you add a sensor, update NUM_SENSORS above! */
4819fe789f8SKyle McMartin static struct sensor_template meter_attrs[] = {
4823c45f2c7SKyle McMartin 	RO_SENSOR_TEMPLATE(POWER_AVERAGE_NAME, show_power, 0),
4833c45f2c7SKyle McMartin 	RO_SENSOR_TEMPLATE("power1_accuracy", show_accuracy, 0),
4843c45f2c7SKyle McMartin 	RO_SENSOR_TEMPLATE("power1_average_interval_min", show_val, 0),
4853c45f2c7SKyle McMartin 	RO_SENSOR_TEMPLATE("power1_average_interval_max", show_val, 1),
4863c45f2c7SKyle McMartin 	RO_SENSOR_TEMPLATE("power1_is_battery", show_val, 5),
4873c45f2c7SKyle McMartin 	RW_SENSOR_TEMPLATE(POWER_AVG_INTERVAL_NAME, show_avg_interval,
4883c45f2c7SKyle McMartin 			   set_avg_interval, 0),
48981194cd2SKyle McMartin 	{},
4907d033365SJean Delvare };
4917d033365SJean Delvare 
49281194cd2SKyle McMartin static struct sensor_template misc_cap_attrs[] = {
4933c45f2c7SKyle McMartin 	RO_SENSOR_TEMPLATE("power1_cap_min", show_val, 2),
4943c45f2c7SKyle McMartin 	RO_SENSOR_TEMPLATE("power1_cap_max", show_val, 3),
4953c45f2c7SKyle McMartin 	RO_SENSOR_TEMPLATE("power1_cap_hyst", show_val, 4),
4963c45f2c7SKyle McMartin 	RO_SENSOR_TEMPLATE(POWER_ALARM_NAME, show_val, 6),
49781194cd2SKyle McMartin 	{},
4987d033365SJean Delvare };
4997d033365SJean Delvare 
50081194cd2SKyle McMartin static struct sensor_template ro_cap_attrs[] = {
5013c45f2c7SKyle McMartin 	RO_SENSOR_TEMPLATE(POWER_CAP_NAME, show_cap, 0),
50281194cd2SKyle McMartin 	{},
5037d033365SJean Delvare };
5047d033365SJean Delvare 
50581194cd2SKyle McMartin static struct sensor_template rw_cap_attrs[] = {
5063c45f2c7SKyle McMartin 	RW_SENSOR_TEMPLATE(POWER_CAP_NAME, show_cap, set_cap, 0),
50781194cd2SKyle McMartin 	{},
5087d033365SJean Delvare };
5097d033365SJean Delvare 
51081194cd2SKyle McMartin static struct sensor_template trip_attrs[] = {
5113c45f2c7SKyle McMartin 	RW_SENSOR_TEMPLATE("power1_average_min", show_val, set_trip, 7),
5123c45f2c7SKyle McMartin 	RW_SENSOR_TEMPLATE("power1_average_max", show_val, set_trip, 8),
51381194cd2SKyle McMartin 	{},
5147d033365SJean Delvare };
5157d033365SJean Delvare 
51681194cd2SKyle McMartin static struct sensor_template misc_attrs[] = {
5173c45f2c7SKyle McMartin 	RO_SENSOR_TEMPLATE("name", show_name, 0),
5183c45f2c7SKyle McMartin 	RO_SENSOR_TEMPLATE("power1_model_number", show_str, 0),
5193c45f2c7SKyle McMartin 	RO_SENSOR_TEMPLATE("power1_oem_info", show_str, 2),
5203c45f2c7SKyle McMartin 	RO_SENSOR_TEMPLATE("power1_serial_number", show_str, 1),
52181194cd2SKyle McMartin 	{},
5227d033365SJean Delvare };
5237d033365SJean Delvare 
5243c45f2c7SKyle McMartin #undef RO_SENSOR_TEMPLATE
5253c45f2c7SKyle McMartin #undef RW_SENSOR_TEMPLATE
5263c45f2c7SKyle McMartin 
5277d033365SJean Delvare /* Read power domain data */
remove_domain_devices(struct acpi_power_meter_resource * resource)5287d033365SJean Delvare static void remove_domain_devices(struct acpi_power_meter_resource *resource)
5297d033365SJean Delvare {
5307d033365SJean Delvare 	int i;
5317d033365SJean Delvare 
5327d033365SJean Delvare 	if (!resource->num_domain_devices)
5337d033365SJean Delvare 		return;
5347d033365SJean Delvare 
5357d033365SJean Delvare 	for (i = 0; i < resource->num_domain_devices; i++) {
5367d033365SJean Delvare 		struct acpi_device *obj = resource->domain_devices[i];
53759e746caSCorentin Labbe 
5387d033365SJean Delvare 		if (!obj)
5397d033365SJean Delvare 			continue;
5407d033365SJean Delvare 
5417d033365SJean Delvare 		sysfs_remove_link(resource->holders_dir,
5427d033365SJean Delvare 				  kobject_name(&obj->dev.kobj));
5432c59a32dSRafael J. Wysocki 		acpi_dev_put(obj);
5447d033365SJean Delvare 	}
5457d033365SJean Delvare 
5467d033365SJean Delvare 	kfree(resource->domain_devices);
5477d033365SJean Delvare 	kobject_put(resource->holders_dir);
5487d033365SJean Delvare 	resource->num_domain_devices = 0;
5497d033365SJean Delvare }
5507d033365SJean Delvare 
read_domain_devices(struct acpi_power_meter_resource * resource)5517d033365SJean Delvare static int read_domain_devices(struct acpi_power_meter_resource *resource)
5527d033365SJean Delvare {
5537d033365SJean Delvare 	int res = 0;
5547d033365SJean Delvare 	int i;
5557d033365SJean Delvare 	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
5567d033365SJean Delvare 	union acpi_object *pss;
5577d033365SJean Delvare 	acpi_status status;
5587d033365SJean Delvare 
5597d033365SJean Delvare 	status = acpi_evaluate_object(resource->acpi_dev->handle, "_PMD", NULL,
5607d033365SJean Delvare 				      &buffer);
5617d033365SJean Delvare 	if (ACPI_FAILURE(status)) {
562ebf1bef3SRafael J. Wysocki 		acpi_evaluation_failure_warn(resource->acpi_dev->handle, "_PMD",
563ebf1bef3SRafael J. Wysocki 					     status);
5647d033365SJean Delvare 		return -ENODEV;
5657d033365SJean Delvare 	}
5667d033365SJean Delvare 
5677d033365SJean Delvare 	pss = buffer.pointer;
5687d033365SJean Delvare 	if (!pss ||
5697d033365SJean Delvare 	    pss->type != ACPI_TYPE_PACKAGE) {
5707d033365SJean Delvare 		dev_err(&resource->acpi_dev->dev, ACPI_POWER_METER_NAME
5717d033365SJean Delvare 			"Invalid _PMD data\n");
5727d033365SJean Delvare 		res = -EFAULT;
5737d033365SJean Delvare 		goto end;
5747d033365SJean Delvare 	}
5757d033365SJean Delvare 
5767d033365SJean Delvare 	if (!pss->package.count)
5777d033365SJean Delvare 		goto end;
5787d033365SJean Delvare 
5796396bb22SKees Cook 	resource->domain_devices = kcalloc(pss->package.count,
5806396bb22SKees Cook 					   sizeof(struct acpi_device *),
5816396bb22SKees Cook 					   GFP_KERNEL);
5827d033365SJean Delvare 	if (!resource->domain_devices) {
5837d033365SJean Delvare 		res = -ENOMEM;
5847d033365SJean Delvare 		goto end;
5857d033365SJean Delvare 	}
5867d033365SJean Delvare 
5877d033365SJean Delvare 	resource->holders_dir = kobject_create_and_add("measures",
5887d033365SJean Delvare 						       &resource->acpi_dev->dev.kobj);
5897d033365SJean Delvare 	if (!resource->holders_dir) {
5907d033365SJean Delvare 		res = -ENOMEM;
5917d033365SJean Delvare 		goto exit_free;
5927d033365SJean Delvare 	}
5937d033365SJean Delvare 
5947d033365SJean Delvare 	resource->num_domain_devices = pss->package.count;
5957d033365SJean Delvare 
5967d033365SJean Delvare 	for (i = 0; i < pss->package.count; i++) {
5977d033365SJean Delvare 		struct acpi_device *obj;
59859e746caSCorentin Labbe 		union acpi_object *element = &pss->package.elements[i];
5997d033365SJean Delvare 
6007d033365SJean Delvare 		/* Refuse non-references */
6017d033365SJean Delvare 		if (element->type != ACPI_TYPE_LOCAL_REFERENCE)
6027d033365SJean Delvare 			continue;
6037d033365SJean Delvare 
6047d033365SJean Delvare 		/* Create a symlink to domain objects */
60545e9aa1fSRafael J. Wysocki 		obj = acpi_get_acpi_dev(element->reference.handle);
6062c59a32dSRafael J. Wysocki 		resource->domain_devices[i] = obj;
6072c59a32dSRafael J. Wysocki 		if (!obj)
6087d033365SJean Delvare 			continue;
6097d033365SJean Delvare 
6107d033365SJean Delvare 		res = sysfs_create_link(resource->holders_dir, &obj->dev.kobj,
6117d033365SJean Delvare 					kobject_name(&obj->dev.kobj));
6127d033365SJean Delvare 		if (res) {
6132c59a32dSRafael J. Wysocki 			acpi_dev_put(obj);
6147d033365SJean Delvare 			resource->domain_devices[i] = NULL;
6157d033365SJean Delvare 		}
6167d033365SJean Delvare 	}
6177d033365SJean Delvare 
6187d033365SJean Delvare 	res = 0;
6197d033365SJean Delvare 	goto end;
6207d033365SJean Delvare 
6217d033365SJean Delvare exit_free:
6227d033365SJean Delvare 	kfree(resource->domain_devices);
6237d033365SJean Delvare end:
6247d033365SJean Delvare 	kfree(buffer.pointer);
6257d033365SJean Delvare 	return res;
6267d033365SJean Delvare }
6277d033365SJean Delvare 
6287d033365SJean Delvare /* Registration and deregistration */
register_attrs(struct acpi_power_meter_resource * resource,struct sensor_template * attrs)629f49d6a7eSKyle McMartin static int register_attrs(struct acpi_power_meter_resource *resource,
630f49d6a7eSKyle McMartin 			  struct sensor_template *attrs)
6317d033365SJean Delvare {
6327d033365SJean Delvare 	struct device *dev = &resource->acpi_dev->dev;
6337d033365SJean Delvare 	struct sensor_device_attribute *sensors =
6347d033365SJean Delvare 		&resource->sensors[resource->num_sensors];
6357d033365SJean Delvare 	int res = 0;
6367d033365SJean Delvare 
637f49d6a7eSKyle McMartin 	while (attrs->label) {
638f49d6a7eSKyle McMartin 		sensors->dev_attr.attr.name = attrs->label;
639419eeabcSGuenter Roeck 		sensors->dev_attr.attr.mode = 0444;
640f49d6a7eSKyle McMartin 		sensors->dev_attr.show = attrs->show;
641f49d6a7eSKyle McMartin 		sensors->index = attrs->index;
642f49d6a7eSKyle McMartin 
643f49d6a7eSKyle McMartin 		if (attrs->set) {
644419eeabcSGuenter Roeck 			sensors->dev_attr.attr.mode |= 0200;
645f49d6a7eSKyle McMartin 			sensors->dev_attr.store = attrs->set;
646f49d6a7eSKyle McMartin 		}
6477d033365SJean Delvare 
64831e354eeSKyle McMartin 		sysfs_attr_init(&sensors->dev_attr.attr);
6497d033365SJean Delvare 		res = device_create_file(dev, &sensors->dev_attr);
6507d033365SJean Delvare 		if (res) {
6517d033365SJean Delvare 			sensors->dev_attr.attr.name = NULL;
6527d033365SJean Delvare 			goto error;
6537d033365SJean Delvare 		}
6547d033365SJean Delvare 		sensors++;
6557d033365SJean Delvare 		resource->num_sensors++;
656f49d6a7eSKyle McMartin 		attrs++;
6577d033365SJean Delvare 	}
6587d033365SJean Delvare 
6597d033365SJean Delvare error:
6607d033365SJean Delvare 	return res;
6617d033365SJean Delvare }
6627d033365SJean Delvare 
remove_attrs(struct acpi_power_meter_resource * resource)6637d033365SJean Delvare static void remove_attrs(struct acpi_power_meter_resource *resource)
6647d033365SJean Delvare {
6657d033365SJean Delvare 	int i;
6667d033365SJean Delvare 
6677d033365SJean Delvare 	for (i = 0; i < resource->num_sensors; i++) {
6687d033365SJean Delvare 		if (!resource->sensors[i].dev_attr.attr.name)
6697d033365SJean Delvare 			continue;
6707d033365SJean Delvare 		device_remove_file(&resource->acpi_dev->dev,
6717d033365SJean Delvare 				   &resource->sensors[i].dev_attr);
6727d033365SJean Delvare 	}
6737d033365SJean Delvare 
6747d033365SJean Delvare 	remove_domain_devices(resource);
6757d033365SJean Delvare 
6767d033365SJean Delvare 	resource->num_sensors = 0;
6777d033365SJean Delvare }
6787d033365SJean Delvare 
setup_attrs(struct acpi_power_meter_resource * resource)6797d033365SJean Delvare static int setup_attrs(struct acpi_power_meter_resource *resource)
6807d033365SJean Delvare {
6817d033365SJean Delvare 	int res = 0;
6827d033365SJean Delvare 
6837d033365SJean Delvare 	res = read_domain_devices(resource);
6847d033365SJean Delvare 	if (res)
6857d033365SJean Delvare 		return res;
6867d033365SJean Delvare 
6877d033365SJean Delvare 	if (resource->caps.flags & POWER_METER_CAN_MEASURE) {
6889fe789f8SKyle McMartin 		res = register_attrs(resource, meter_attrs);
6897d033365SJean Delvare 		if (res)
6907d033365SJean Delvare 			goto error;
6917d033365SJean Delvare 	}
6927d033365SJean Delvare 
6937d033365SJean Delvare 	if (resource->caps.flags & POWER_METER_CAN_CAP) {
6947d033365SJean Delvare 		if (!can_cap_in_hardware()) {
6956e4d91aaSWang Shenran 			dev_warn(&resource->acpi_dev->dev,
6967d033365SJean Delvare 				 "Ignoring unsafe software power cap!\n");
6977d033365SJean Delvare 			goto skip_unsafe_cap;
6987d033365SJean Delvare 		}
6997d033365SJean Delvare 
7007bb5ee01SKyle McMartin 		if (resource->caps.configurable_cap)
701f49d6a7eSKyle McMartin 			res = register_attrs(resource, rw_cap_attrs);
7027bb5ee01SKyle McMartin 		else
703f49d6a7eSKyle McMartin 			res = register_attrs(resource, ro_cap_attrs);
7047bb5ee01SKyle McMartin 
7057d033365SJean Delvare 		if (res)
7067d033365SJean Delvare 			goto error;
7077bb5ee01SKyle McMartin 
708f49d6a7eSKyle McMartin 		res = register_attrs(resource, misc_cap_attrs);
7097d033365SJean Delvare 		if (res)
7107d033365SJean Delvare 			goto error;
7117d033365SJean Delvare 	}
7127d033365SJean Delvare 
7137bb5ee01SKyle McMartin skip_unsafe_cap:
7147d033365SJean Delvare 	if (resource->caps.flags & POWER_METER_CAN_TRIP) {
715f49d6a7eSKyle McMartin 		res = register_attrs(resource, trip_attrs);
7167d033365SJean Delvare 		if (res)
7177d033365SJean Delvare 			goto error;
7187d033365SJean Delvare 	}
7197d033365SJean Delvare 
720f49d6a7eSKyle McMartin 	res = register_attrs(resource, misc_attrs);
7217d033365SJean Delvare 	if (res)
7227d033365SJean Delvare 		goto error;
7237d033365SJean Delvare 
7247d033365SJean Delvare 	return res;
7257d033365SJean Delvare error:
7267d033365SJean Delvare 	remove_attrs(resource);
7277d033365SJean Delvare 	return res;
7287d033365SJean Delvare }
7297d033365SJean Delvare 
free_capabilities(struct acpi_power_meter_resource * resource)7307d033365SJean Delvare static void free_capabilities(struct acpi_power_meter_resource *resource)
7317d033365SJean Delvare {
7327d033365SJean Delvare 	acpi_string *str;
7337d033365SJean Delvare 	int i;
7347d033365SJean Delvare 
7357d033365SJean Delvare 	str = &resource->model_number;
73696eca8c9SDan Carpenter 	for (i = 0; i < 3; i++, str++) {
7377d033365SJean Delvare 		kfree(*str);
73896eca8c9SDan Carpenter 		*str = NULL;
73996eca8c9SDan Carpenter 	}
7407d033365SJean Delvare }
7417d033365SJean Delvare 
read_capabilities(struct acpi_power_meter_resource * resource)7427d033365SJean Delvare static int read_capabilities(struct acpi_power_meter_resource *resource)
7437d033365SJean Delvare {
7447d033365SJean Delvare 	int res = 0;
7457d033365SJean Delvare 	int i;
7467d033365SJean Delvare 	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
7477d033365SJean Delvare 	struct acpi_buffer state = { 0, NULL };
7487d033365SJean Delvare 	struct acpi_buffer format = { sizeof("NNNNNNNNNNN"), "NNNNNNNNNNN" };
7497d033365SJean Delvare 	union acpi_object *pss;
7507d033365SJean Delvare 	acpi_string *str;
7517d033365SJean Delvare 	acpi_status status;
7527d033365SJean Delvare 
7537d033365SJean Delvare 	status = acpi_evaluate_object(resource->acpi_dev->handle, "_PMC", NULL,
7547d033365SJean Delvare 				      &buffer);
7557d033365SJean Delvare 	if (ACPI_FAILURE(status)) {
756ebf1bef3SRafael J. Wysocki 		acpi_evaluation_failure_warn(resource->acpi_dev->handle, "_PMC",
757ebf1bef3SRafael J. Wysocki 					     status);
7587d033365SJean Delvare 		return -ENODEV;
7597d033365SJean Delvare 	}
7607d033365SJean Delvare 
7617d033365SJean Delvare 	pss = buffer.pointer;
7627d033365SJean Delvare 	if (!pss ||
7637d033365SJean Delvare 	    pss->type != ACPI_TYPE_PACKAGE ||
7647d033365SJean Delvare 	    pss->package.count != 14) {
7657d033365SJean Delvare 		dev_err(&resource->acpi_dev->dev, ACPI_POWER_METER_NAME
7667d033365SJean Delvare 			"Invalid _PMC data\n");
7677d033365SJean Delvare 		res = -EFAULT;
7687d033365SJean Delvare 		goto end;
7697d033365SJean Delvare 	}
7707d033365SJean Delvare 
7717d033365SJean Delvare 	/* Grab all the integer data at once */
7727d033365SJean Delvare 	state.length = sizeof(struct acpi_power_meter_capabilities);
7737d033365SJean Delvare 	state.pointer = &resource->caps;
7747d033365SJean Delvare 
7757d033365SJean Delvare 	status = acpi_extract_package(pss, &format, &state);
7767d033365SJean Delvare 	if (ACPI_FAILURE(status)) {
777ebf1bef3SRafael J. Wysocki 		dev_err(&resource->acpi_dev->dev, ACPI_POWER_METER_NAME
778ebf1bef3SRafael J. Wysocki 			"_PMC package parsing failed: %s\n",
779ebf1bef3SRafael J. Wysocki 			acpi_format_exception(status));
7807d033365SJean Delvare 		res = -EFAULT;
7817d033365SJean Delvare 		goto end;
7827d033365SJean Delvare 	}
7837d033365SJean Delvare 
7847d033365SJean Delvare 	if (resource->caps.units) {
7857d033365SJean Delvare 		dev_err(&resource->acpi_dev->dev, ACPI_POWER_METER_NAME
7867d033365SJean Delvare 			"Unknown units %llu.\n",
7877d033365SJean Delvare 			resource->caps.units);
7887d033365SJean Delvare 		res = -EINVAL;
7897d033365SJean Delvare 		goto end;
7907d033365SJean Delvare 	}
7917d033365SJean Delvare 
7927d033365SJean Delvare 	/* Grab the string data */
7937d033365SJean Delvare 	str = &resource->model_number;
7947d033365SJean Delvare 
7957d033365SJean Delvare 	for (i = 11; i < 14; i++) {
79659e746caSCorentin Labbe 		union acpi_object *element = &pss->package.elements[i];
7977d033365SJean Delvare 
7987d033365SJean Delvare 		if (element->type != ACPI_TYPE_STRING) {
7997d033365SJean Delvare 			res = -EINVAL;
8007d033365SJean Delvare 			goto error;
8017d033365SJean Delvare 		}
8027d033365SJean Delvare 
8036396bb22SKees Cook 		*str = kcalloc(element->string.length + 1, sizeof(u8),
8047d033365SJean Delvare 			       GFP_KERNEL);
8057d033365SJean Delvare 		if (!*str) {
8067d033365SJean Delvare 			res = -ENOMEM;
8077d033365SJean Delvare 			goto error;
8087d033365SJean Delvare 		}
8097d033365SJean Delvare 
8107d033365SJean Delvare 		strncpy(*str, element->string.pointer, element->string.length);
8117d033365SJean Delvare 		str++;
8127d033365SJean Delvare 	}
8137d033365SJean Delvare 
8147d033365SJean Delvare 	dev_info(&resource->acpi_dev->dev, "Found ACPI power meter.\n");
8157d033365SJean Delvare 	goto end;
8167d033365SJean Delvare error:
81796eca8c9SDan Carpenter 	free_capabilities(resource);
8187d033365SJean Delvare end:
8197d033365SJean Delvare 	kfree(buffer.pointer);
8207d033365SJean Delvare 	return res;
8217d033365SJean Delvare }
8227d033365SJean Delvare 
8237d033365SJean Delvare /* Handle ACPI event notifications */
acpi_power_meter_notify(struct acpi_device * device,u32 event)8247d033365SJean Delvare static void acpi_power_meter_notify(struct acpi_device *device, u32 event)
8257d033365SJean Delvare {
8267d033365SJean Delvare 	struct acpi_power_meter_resource *resource;
8277d033365SJean Delvare 	int res;
8287d033365SJean Delvare 
8297d033365SJean Delvare 	if (!device || !acpi_driver_data(device))
8307d033365SJean Delvare 		return;
8317d033365SJean Delvare 
8327d033365SJean Delvare 	resource = acpi_driver_data(device);
8337d033365SJean Delvare 
8347d033365SJean Delvare 	switch (event) {
8357d033365SJean Delvare 	case METER_NOTIFY_CONFIG:
836badcd454SGuenter Roeck 		mutex_lock(&resource->lock);
8377d033365SJean Delvare 		free_capabilities(resource);
8387d033365SJean Delvare 		res = read_capabilities(resource);
839badcd454SGuenter Roeck 		mutex_unlock(&resource->lock);
8407d033365SJean Delvare 		if (res)
8417d033365SJean Delvare 			break;
8427d033365SJean Delvare 
8437d033365SJean Delvare 		remove_attrs(resource);
8447d033365SJean Delvare 		setup_attrs(resource);
8457d033365SJean Delvare 		break;
8467d033365SJean Delvare 	case METER_NOTIFY_TRIP:
8477d033365SJean Delvare 		sysfs_notify(&device->dev.kobj, NULL, POWER_AVERAGE_NAME);
8487d033365SJean Delvare 		break;
8497d033365SJean Delvare 	case METER_NOTIFY_CAP:
8507d033365SJean Delvare 		sysfs_notify(&device->dev.kobj, NULL, POWER_CAP_NAME);
8517d033365SJean Delvare 		break;
8527d033365SJean Delvare 	case METER_NOTIFY_INTERVAL:
8537d033365SJean Delvare 		sysfs_notify(&device->dev.kobj, NULL, POWER_AVG_INTERVAL_NAME);
8547d033365SJean Delvare 		break;
8557d033365SJean Delvare 	case METER_NOTIFY_CAPPING:
8567d033365SJean Delvare 		sysfs_notify(&device->dev.kobj, NULL, POWER_ALARM_NAME);
8577d033365SJean Delvare 		dev_info(&device->dev, "Capping in progress.\n");
8587d033365SJean Delvare 		break;
8597d033365SJean Delvare 	default:
86083c97fe1SGuenter Roeck 		WARN(1, "Unexpected event %d\n", event);
86183c97fe1SGuenter Roeck 		break;
8627d033365SJean Delvare 	}
8637d033365SJean Delvare 
8647d033365SJean Delvare 	acpi_bus_generate_netlink_event(ACPI_POWER_METER_CLASS,
8657d033365SJean Delvare 					dev_name(&device->dev), event, 0);
8667d033365SJean Delvare }
8677d033365SJean Delvare 
acpi_power_meter_add(struct acpi_device * device)8687d033365SJean Delvare static int acpi_power_meter_add(struct acpi_device *device)
8697d033365SJean Delvare {
8707d033365SJean Delvare 	int res;
8717d033365SJean Delvare 	struct acpi_power_meter_resource *resource;
8727d033365SJean Delvare 
8737d033365SJean Delvare 	if (!device)
8747d033365SJean Delvare 		return -EINVAL;
8757d033365SJean Delvare 
87659e746caSCorentin Labbe 	resource = kzalloc(sizeof(*resource), GFP_KERNEL);
8777d033365SJean Delvare 	if (!resource)
8787d033365SJean Delvare 		return -ENOMEM;
8797d033365SJean Delvare 
8807d033365SJean Delvare 	resource->sensors_valid = 0;
8817d033365SJean Delvare 	resource->acpi_dev = device;
8827d033365SJean Delvare 	mutex_init(&resource->lock);
8837d033365SJean Delvare 	strcpy(acpi_device_name(device), ACPI_POWER_METER_DEVICE_NAME);
8847d033365SJean Delvare 	strcpy(acpi_device_class(device), ACPI_POWER_METER_CLASS);
8857d033365SJean Delvare 	device->driver_data = resource;
8867d033365SJean Delvare 
8877d033365SJean Delvare 	res = read_capabilities(resource);
8887d033365SJean Delvare 	if (res)
8897d033365SJean Delvare 		goto exit_free;
8907d033365SJean Delvare 
89159e746caSCorentin Labbe 	resource->trip[0] = -1;
89259e746caSCorentin Labbe 	resource->trip[1] = -1;
8937d033365SJean Delvare 
8947d033365SJean Delvare 	res = setup_attrs(resource);
8957d033365SJean Delvare 	if (res)
8968b97f992SMisono Tomohiro 		goto exit_free_capability;
8977d033365SJean Delvare 
8987d033365SJean Delvare 	resource->hwmon_dev = hwmon_device_register(&device->dev);
8997d033365SJean Delvare 	if (IS_ERR(resource->hwmon_dev)) {
9007d033365SJean Delvare 		res = PTR_ERR(resource->hwmon_dev);
9017d033365SJean Delvare 		goto exit_remove;
9027d033365SJean Delvare 	}
9037d033365SJean Delvare 
9047d033365SJean Delvare 	res = 0;
9057d033365SJean Delvare 	goto exit;
9067d033365SJean Delvare 
9077d033365SJean Delvare exit_remove:
9087d033365SJean Delvare 	remove_attrs(resource);
9098b97f992SMisono Tomohiro exit_free_capability:
9108b97f992SMisono Tomohiro 	free_capabilities(resource);
9117d033365SJean Delvare exit_free:
9127d033365SJean Delvare 	kfree(resource);
9137d033365SJean Delvare exit:
9147d033365SJean Delvare 	return res;
9157d033365SJean Delvare }
9167d033365SJean Delvare 
acpi_power_meter_remove(struct acpi_device * device)9176c0eb5baSDawei Li static void acpi_power_meter_remove(struct acpi_device *device)
9187d033365SJean Delvare {
9197d033365SJean Delvare 	struct acpi_power_meter_resource *resource;
9207d033365SJean Delvare 
9217d033365SJean Delvare 	if (!device || !acpi_driver_data(device))
9226c0eb5baSDawei Li 		return;
9237d033365SJean Delvare 
9247d033365SJean Delvare 	resource = acpi_driver_data(device);
9257d033365SJean Delvare 	hwmon_device_unregister(resource->hwmon_dev);
9267d033365SJean Delvare 
9277d033365SJean Delvare 	remove_attrs(resource);
928badcd454SGuenter Roeck 	free_capabilities(resource);
9297d033365SJean Delvare 
9307d033365SJean Delvare 	kfree(resource);
9317d033365SJean Delvare }
9327d033365SJean Delvare 
acpi_power_meter_resume(struct device * dev)933c5dec018SRafael J. Wysocki static int acpi_power_meter_resume(struct device *dev)
9347d033365SJean Delvare {
9357d033365SJean Delvare 	struct acpi_power_meter_resource *resource;
9367d033365SJean Delvare 
937c5dec018SRafael J. Wysocki 	if (!dev)
9387d033365SJean Delvare 		return -EINVAL;
9397d033365SJean Delvare 
940c5dec018SRafael J. Wysocki 	resource = acpi_driver_data(to_acpi_device(dev));
941c5dec018SRafael J. Wysocki 	if (!resource)
942c5dec018SRafael J. Wysocki 		return -EINVAL;
943c5dec018SRafael J. Wysocki 
9447d033365SJean Delvare 	free_capabilities(resource);
9457d033365SJean Delvare 	read_capabilities(resource);
9467d033365SJean Delvare 
9477d033365SJean Delvare 	return 0;
9487d033365SJean Delvare }
9497d033365SJean Delvare 
95000f4095cSJonathan Cameron static DEFINE_SIMPLE_DEV_PM_OPS(acpi_power_meter_pm, NULL,
95100f4095cSJonathan Cameron 				acpi_power_meter_resume);
952c5dec018SRafael J. Wysocki 
9537d033365SJean Delvare static struct acpi_driver acpi_power_meter_driver = {
9547d033365SJean Delvare 	.name = "power_meter",
9557d033365SJean Delvare 	.class = ACPI_POWER_METER_CLASS,
9567d033365SJean Delvare 	.ids = power_meter_ids,
9577d033365SJean Delvare 	.ops = {
9587d033365SJean Delvare 		.add = acpi_power_meter_add,
9597d033365SJean Delvare 		.remove = acpi_power_meter_remove,
9607d033365SJean Delvare 		.notify = acpi_power_meter_notify,
9617d033365SJean Delvare 		},
96200f4095cSJonathan Cameron 	.drv.pm = pm_sleep_ptr(&acpi_power_meter_pm),
9637d033365SJean Delvare };
9647d033365SJean Delvare 
9657d033365SJean Delvare /* Module init/exit routines */
enable_cap_knobs(const struct dmi_system_id * d)9667d033365SJean Delvare static int __init enable_cap_knobs(const struct dmi_system_id *d)
9677d033365SJean Delvare {
9687d033365SJean Delvare 	cap_in_hardware = 1;
9697d033365SJean Delvare 	return 0;
9707d033365SJean Delvare }
9717d033365SJean Delvare 
9726faadbbbSChristoph Hellwig static const struct dmi_system_id pm_dmi_table[] __initconst = {
9737d033365SJean Delvare 	{
9747d033365SJean Delvare 		enable_cap_knobs, "IBM Active Energy Manager",
9757d033365SJean Delvare 		{
9767d033365SJean Delvare 			DMI_MATCH(DMI_SYS_VENDOR, "IBM")
9777d033365SJean Delvare 		},
9787d033365SJean Delvare 	},
9797d033365SJean Delvare 	{}
9807d033365SJean Delvare };
9817d033365SJean Delvare 
acpi_power_meter_init(void)9827d033365SJean Delvare static int __init acpi_power_meter_init(void)
9837d033365SJean Delvare {
9847d033365SJean Delvare 	int result;
9857d033365SJean Delvare 
9867d033365SJean Delvare 	if (acpi_disabled)
9877d033365SJean Delvare 		return -ENODEV;
9887d033365SJean Delvare 
9897d033365SJean Delvare 	dmi_check_system(pm_dmi_table);
9907d033365SJean Delvare 
9917d033365SJean Delvare 	result = acpi_bus_register_driver(&acpi_power_meter_driver);
9927d033365SJean Delvare 	if (result < 0)
99319f053c8SGuenter Roeck 		return result;
9947d033365SJean Delvare 
9957d033365SJean Delvare 	return 0;
9967d033365SJean Delvare }
9977d033365SJean Delvare 
acpi_power_meter_exit(void)9987d033365SJean Delvare static void __exit acpi_power_meter_exit(void)
9997d033365SJean Delvare {
10007d033365SJean Delvare 	acpi_bus_unregister_driver(&acpi_power_meter_driver);
10017d033365SJean Delvare }
10027d033365SJean Delvare 
10035407e051SDarrick J. Wong MODULE_AUTHOR("Darrick J. Wong <darrick.wong@oracle.com>");
10047d033365SJean Delvare MODULE_DESCRIPTION("ACPI 4.0 power meter driver");
10057d033365SJean Delvare MODULE_LICENSE("GPL");
10067d033365SJean Delvare 
10077d033365SJean Delvare module_param(force_cap_on, bool, 0644);
10087d033365SJean Delvare MODULE_PARM_DESC(force_cap_on, "Enable power cap even it is unsafe to do so.");
10097d033365SJean Delvare 
10107d033365SJean Delvare module_init(acpi_power_meter_init);
10117d033365SJean Delvare module_exit(acpi_power_meter_exit);
1012