Add hwmon sys I/F for generic thermal driver.
Note: we have one hwmon class device for _EACH_ type of the thermal zone device.
Signed-off-by: Zhang Rui <rui.zhang at intel.com>
---
drivers/thermal/thermal.c | 155 ++++++++++++++++++++++++++++++++++++++++++++++
include/linux/thermal.h | 25 +++++++
2 files changed, 180 insertions(+)
Index: linux-2.6/drivers/thermal/thermal.c
===================================================================
--- linux-2.6.orig/drivers/thermal/thermal.c
+++ linux-2.6/drivers/thermal/thermal.c
@@ -30,6 +30,7 @@
#include <linux/idr.h>
#include <linux/thermal.h>
#include <linux/spinlock.h>
+#include <linux/hwmon.h>
MODULE_AUTHOR("Zhang Rui");
MODULE_DESCRIPTION("Generic thermal management sysfs support");
@@ -291,6 +292,155 @@ thermal_cooling_device_trip_point_show(s
/* Device management */
+#if defined(CONFIG_HWMON) || \
+ (defined(CONFIG_HWMON_MODULE) && defined(CONFIG_THERMAL_MODULE))
+/* hwmon sys I/F */
+static LIST_HEAD(thermal_hwmon_list);
+
+static ssize_t
+name_show(struct device *dev, struct device_attribute *attr, char *buf)
+{
+ struct hwmon_device_instance *hwmon =
+ container_of(attr, struct hwmon_device_instance, name);
+ return sprintf(buf, "%s\n", hwmon->type);
+}
+
+static ssize_t
+temp_input_show(struct device *dev, struct device_attribute *attr, char *buf)
+{
+ struct thermal_hwmon_attr *hwmon_attr
+ = container_of(attr, struct thermal_hwmon_attr, attr);
+ struct thermal_zone_device *tz
+ = container_of(hwmon_attr, struct thermal_zone_device,
+ temp_input);
+
+ return tz->ops->get_temp(tz, buf);
+}
+
+static ssize_t
+temp_crit_show(struct device *dev, struct device_attribute *attr,
+ char *buf)
+{
+ struct thermal_hwmon_attr *hwmon_attr
+ = container_of(attr, struct thermal_hwmon_attr, attr);
+ struct thermal_zone_device *tz
+ = container_of(hwmon_attr, struct thermal_zone_device,
+ temp_crit);
+
+ return tz->ops->get_trip_temp(tz, 0, buf);
+}
+
+
+static int
+thermal_add_hwmon_sysfs(struct thermal_zone_device *tz)
+{
+ struct hwmon_device_instance *hwmon;
+ int result;
+
+ mutex_lock(&thermal_list_lock);
+ list_for_each_entry(hwmon, &thermal_hwmon_list, node)
+ if (!strcmp(hwmon->type, tz->type)) {
+ list_add_tail(&tz->hwmon_node,
+ &hwmon->tz_list);
+ mutex_unlock(&thermal_list_lock);
+ tz->hwmon = hwmon;
+ goto register_sys_interface;
+ }
+ mutex_unlock(&thermal_list_lock);
+
+ hwmon = kzalloc(sizeof(struct hwmon_device_instance), GFP_KERNEL);
+ if (!hwmon)
+ return -ENOMEM;
+
+ INIT_LIST_HEAD(&hwmon->tz_list);
+ strcpy(hwmon->type, tz->type);
+ hwmon->device = hwmon_device_register(NULL);
+ hwmon->name.attr.name = "name";
+ hwmon->name.attr.mode = 0444;
+ hwmon->name.show = name_show;
+ result = device_create_file(hwmon->device, &hwmon->name);
+ if (result)
+ return result;
+
+
+ mutex_lock(&thermal_list_lock);
+ list_add_tail(&hwmon->node, &thermal_hwmon_list);
+ list_add_tail(&tz->hwmon_node, &hwmon->tz_list);
+ mutex_unlock(&thermal_list_lock);
+
+ tz->hwmon = hwmon;
+
+ register_sys_interface:
+ hwmon->count++;
+
+ sprintf(tz->temp_input.name, "temp%d_input", hwmon->count);
+ tz->temp_input.attr.attr.name = tz->temp_input.name;
+ tz->temp_input.attr.attr.mode = 0444;
+ tz->temp_input.attr.show = temp_input_show;
+ result = device_create_file(hwmon->device, &tz->temp_input.attr);
+ if (result)
+ return result;
+
+ if (tz->trips > 0) {
+ char buf[40];
+ result = tz->ops->get_trip_type(tz, 0, buf);
+ if (result > 0 && !strcmp(buf, "critical\n")) {
+ sprintf(tz->temp_crit.name,
+ "temp%d_crit", hwmon->count);
+ tz->temp_crit.attr.attr.name = tz->temp_crit.name;
+ tz->temp_crit.attr.attr.mode = 0444;
+ tz->temp_crit.attr.show = temp_crit_show;
+ result = device_create_file(hwmon->device,
+ &tz->temp_crit.attr);
+ if (result)
+ return result;
+ }
+ }
+
+ return 0;
+}
+
+static int
+thermal_remove_hwmon_sysfs(struct thermal_zone_device *tz)
+{
+ struct hwmon_device_instance *hwmon;
+
+ mutex_lock(&thermal_list_lock);
+ list_for_each_entry(hwmon, &thermal_hwmon_list, node) {
+ if (strcmp(hwmon->type, tz->type))
+ continue;
+
+ device_remove_file(hwmon->device, &tz->temp_input.attr);
+ if (!tz->temp_crit.attr.attr.name)
+ device_remove_file(hwmon->device, &tz->temp_crit.attr);
+ list_del(&tz->hwmon_node);
+ if (list_empty(&tz->hwmon->tz_list)) {
+ device_remove_file(tz->hwmon->device, &tz->hwmon->name);
+ hwmon_device_unregister(tz->hwmon->device);
+ list_del(&tz->hwmon->node);
+ mutex_unlock(&thermal_list_lock);
+ return 0;
+ }
+ }
+ mutex_unlock(&thermal_list_lock);
+
+ return -EINVAL;
+}
+#else
+static int
+thermal_add_hwmon_sysfs(struct thermal_zone_device *tz)
+{
+ return 0;
+}
+
+static int
+thermal_remove_hwmon_sysfs(struct thermal_zone_device *tz)
+{
+ return 0;
+}
+#endif
+
+
/**
* thermal_zone_bind_cooling_device - bind a cooling device to a thermal zone
* @tz: thermal zone device
@@ -638,6 +788,10 @@ struct thermal_zone_device *thermal_zone
goto unregister;
}
+ result = thermal_add_hwmon_sysfs(tz);
+ if (result)
+ goto unregister;
+
mutex_lock(&thermal_list_lock);
list_add_tail(&tz->node, &thermal_tz_list);
if (ops->bind)
@@ -696,6 +850,7 @@ void thermal_zone_device_unregister(stru
for (count = 0; count < tz->trips; count++)
TRIP_POINT_ATTR_REMOVE(&tz->device, count);
+ thermal_remove_hwmon_sysfs(tz);
release_idr(&thermal_tz_idr, &thermal_idr_lock, tz->id);
idr_destroy(&tz->idr);
mutex_destroy(&tz->lock);
Index: linux-2.6/include/linux/thermal.h
===================================================================
--- linux-2.6.orig/include/linux/thermal.h
+++ linux-2.6/include/linux/thermal.h
@@ -65,6 +65,24 @@ struct thermal_cooling_device {
((long)t-2732+5)/10 : ((long)t-2732-5)/10)
#define CELSIUS_TO_KELVIN(t) ((t)*10+2732)
+#if defined(CONFIG_HWMON) || \
+ (defined(CONFIG_HWMON_MODULE) && defined(CONFIG_THERMAL_MODULE))
+/* thermal zone devices with the same type share one hwmon device */
+struct hwmon_device_instance {
+ char type[THERMAL_NAME_LENGTH];
+ struct device *device;
+ struct device_attribute name;
+ int count;
+ struct list_head tz_list;
+ struct list_head node;
+};
+
+struct thermal_hwmon_attr {
+ struct device_attribute attr;
+ char name[16];
+};
+#endif
+
struct thermal_zone_device {
int id;
char type[THERMAL_NAME_LENGTH];
@@ -76,6 +94,13 @@ struct thermal_zone_device {
struct idr idr;
struct mutex lock; /* protect cooling devices list */
struct list_head node;
+#if defined(CONFIG_HWMON) || \
+ (defined(CONFIG_HWMON_MODULE) && defined(CONFIG_THERMAL_MODULE))
+ struct list_head hwmon_node; /* node in thermal_hwmon_list */
+ struct hwmon_device_instance *hwmon;
+ struct thermal_hwmon_attr temp_input; /* hwmon sys attr */
+ struct thermal_hwmon_attr temp_crit; /* hwmon sys attr */
+#endif
};
struct thermal_zone_device *thermal_zone_device_register(char *, int, void *,
