1 /* 2 * thermal_hwmon.c - Generic Thermal Management hwmon support. 3 * 4 * Code based on Intel thermal_core.c. Copyrights of the original code: 5 * Copyright (C) 2008 Intel Corp 6 * Copyright (C) 2008 Zhang Rui <rui.zhang@intel.com> 7 * Copyright (C) 2008 Sujith Thomas <sujith.thomas@intel.com> 8 * 9 * Copyright (C) 2013 Texas Instruments 10 * Copyright (C) 2013 Eduardo Valentin <eduardo.valentin@ti.com> 11 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ 12 * 13 * This program is free software; you can redistribute it and/or modify 14 * it under the terms of the GNU General Public License as published by 15 * the Free Software Foundation; version 2 of the License. 16 * 17 * This program is distributed in the hope that it will be useful, but 18 * WITHOUT ANY WARRANTY; without even the implied warranty of 19 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 20 * General Public License for more details. 21 * 22 * You should have received a copy of the GNU General Public License along 23 * with this program; if not, write to the Free Software Foundation, Inc., 24 * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA. 25 * 26 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ 27 */ 28 #include <linux/hwmon.h> 29 #include <linux/thermal.h> 30 #include <linux/slab.h> 31 #include <linux/err.h> 32 #include "thermal_hwmon.h" 33 34 /* hwmon sys I/F */ 35 /* thermal zone devices with the same type share one hwmon device */ 36 struct thermal_hwmon_device { 37 char type[THERMAL_NAME_LENGTH]; 38 struct device *device; 39 int count; 40 struct list_head tz_list; 41 struct list_head node; 42 }; 43 44 struct thermal_hwmon_attr { 45 struct device_attribute attr; 46 char name[16]; 47 }; 48 49 /* one temperature input for each thermal zone */ 50 struct thermal_hwmon_temp { 51 struct list_head hwmon_node; 52 struct thermal_zone_device *tz; 53 struct thermal_hwmon_attr temp_input; /* hwmon sys attr */ 54 struct thermal_hwmon_attr temp_crit; /* hwmon sys attr */ 55 }; 56 57 static LIST_HEAD(thermal_hwmon_list); 58 59 static DEFINE_MUTEX(thermal_hwmon_list_lock); 60 61 static ssize_t 62 name_show(struct device *dev, struct device_attribute *attr, char *buf) 63 { 64 struct thermal_hwmon_device *hwmon = dev_get_drvdata(dev); 65 return sprintf(buf, "%s\n", hwmon->type); 66 } 67 static DEVICE_ATTR_RO(name); 68 69 static ssize_t 70 temp_input_show(struct device *dev, struct device_attribute *attr, char *buf) 71 { 72 int temperature; 73 int ret; 74 struct thermal_hwmon_attr *hwmon_attr 75 = container_of(attr, struct thermal_hwmon_attr, attr); 76 struct thermal_hwmon_temp *temp 77 = container_of(hwmon_attr, struct thermal_hwmon_temp, 78 temp_input); 79 struct thermal_zone_device *tz = temp->tz; 80 81 ret = thermal_zone_get_temp(tz, &temperature); 82 83 if (ret) 84 return ret; 85 86 return sprintf(buf, "%d\n", temperature); 87 } 88 89 static ssize_t 90 temp_crit_show(struct device *dev, struct device_attribute *attr, char *buf) 91 { 92 struct thermal_hwmon_attr *hwmon_attr 93 = container_of(attr, struct thermal_hwmon_attr, attr); 94 struct thermal_hwmon_temp *temp 95 = container_of(hwmon_attr, struct thermal_hwmon_temp, 96 temp_crit); 97 struct thermal_zone_device *tz = temp->tz; 98 int temperature; 99 int ret; 100 101 ret = tz->ops->get_crit_temp(tz, &temperature); 102 if (ret) 103 return ret; 104 105 return sprintf(buf, "%d\n", temperature); 106 } 107 108 109 static struct thermal_hwmon_device * 110 thermal_hwmon_lookup_by_type(const struct thermal_zone_device *tz) 111 { 112 struct thermal_hwmon_device *hwmon; 113 114 mutex_lock(&thermal_hwmon_list_lock); 115 list_for_each_entry(hwmon, &thermal_hwmon_list, node) 116 if (!strcmp(hwmon->type, tz->type)) { 117 mutex_unlock(&thermal_hwmon_list_lock); 118 return hwmon; 119 } 120 mutex_unlock(&thermal_hwmon_list_lock); 121 122 return NULL; 123 } 124 125 /* Find the temperature input matching a given thermal zone */ 126 static struct thermal_hwmon_temp * 127 thermal_hwmon_lookup_temp(const struct thermal_hwmon_device *hwmon, 128 const struct thermal_zone_device *tz) 129 { 130 struct thermal_hwmon_temp *temp; 131 132 mutex_lock(&thermal_hwmon_list_lock); 133 list_for_each_entry(temp, &hwmon->tz_list, hwmon_node) 134 if (temp->tz == tz) { 135 mutex_unlock(&thermal_hwmon_list_lock); 136 return temp; 137 } 138 mutex_unlock(&thermal_hwmon_list_lock); 139 140 return NULL; 141 } 142 143 static bool thermal_zone_crit_temp_valid(struct thermal_zone_device *tz) 144 { 145 int temp; 146 return tz->ops->get_crit_temp && !tz->ops->get_crit_temp(tz, &temp); 147 } 148 149 int thermal_add_hwmon_sysfs(struct thermal_zone_device *tz) 150 { 151 struct thermal_hwmon_device *hwmon; 152 struct thermal_hwmon_temp *temp; 153 int new_hwmon_device = 1; 154 int result; 155 156 hwmon = thermal_hwmon_lookup_by_type(tz); 157 if (hwmon) { 158 new_hwmon_device = 0; 159 goto register_sys_interface; 160 } 161 162 hwmon = kzalloc(sizeof(*hwmon), GFP_KERNEL); 163 if (!hwmon) 164 return -ENOMEM; 165 166 INIT_LIST_HEAD(&hwmon->tz_list); 167 strlcpy(hwmon->type, tz->type, THERMAL_NAME_LENGTH); 168 hwmon->device = hwmon_device_register(NULL); 169 if (IS_ERR(hwmon->device)) { 170 result = PTR_ERR(hwmon->device); 171 goto free_mem; 172 } 173 dev_set_drvdata(hwmon->device, hwmon); 174 result = device_create_file(hwmon->device, &dev_attr_name); 175 if (result) 176 goto free_mem; 177 178 register_sys_interface: 179 temp = kzalloc(sizeof(*temp), GFP_KERNEL); 180 if (!temp) { 181 result = -ENOMEM; 182 goto unregister_name; 183 } 184 185 temp->tz = tz; 186 hwmon->count++; 187 188 snprintf(temp->temp_input.name, sizeof(temp->temp_input.name), 189 "temp%d_input", hwmon->count); 190 temp->temp_input.attr.attr.name = temp->temp_input.name; 191 temp->temp_input.attr.attr.mode = 0444; 192 temp->temp_input.attr.show = temp_input_show; 193 sysfs_attr_init(&temp->temp_input.attr.attr); 194 result = device_create_file(hwmon->device, &temp->temp_input.attr); 195 if (result) 196 goto free_temp_mem; 197 198 if (thermal_zone_crit_temp_valid(tz)) { 199 snprintf(temp->temp_crit.name, 200 sizeof(temp->temp_crit.name), 201 "temp%d_crit", hwmon->count); 202 temp->temp_crit.attr.attr.name = temp->temp_crit.name; 203 temp->temp_crit.attr.attr.mode = 0444; 204 temp->temp_crit.attr.show = temp_crit_show; 205 sysfs_attr_init(&temp->temp_crit.attr.attr); 206 result = device_create_file(hwmon->device, 207 &temp->temp_crit.attr); 208 if (result) 209 goto unregister_input; 210 } 211 212 mutex_lock(&thermal_hwmon_list_lock); 213 if (new_hwmon_device) 214 list_add_tail(&hwmon->node, &thermal_hwmon_list); 215 list_add_tail(&temp->hwmon_node, &hwmon->tz_list); 216 mutex_unlock(&thermal_hwmon_list_lock); 217 218 return 0; 219 220 unregister_input: 221 device_remove_file(hwmon->device, &temp->temp_input.attr); 222 free_temp_mem: 223 kfree(temp); 224 unregister_name: 225 if (new_hwmon_device) { 226 device_remove_file(hwmon->device, &dev_attr_name); 227 hwmon_device_unregister(hwmon->device); 228 } 229 free_mem: 230 if (new_hwmon_device) 231 kfree(hwmon); 232 233 return result; 234 } 235 EXPORT_SYMBOL_GPL(thermal_add_hwmon_sysfs); 236 237 void thermal_remove_hwmon_sysfs(struct thermal_zone_device *tz) 238 { 239 struct thermal_hwmon_device *hwmon; 240 struct thermal_hwmon_temp *temp; 241 242 hwmon = thermal_hwmon_lookup_by_type(tz); 243 if (unlikely(!hwmon)) { 244 /* Should never happen... */ 245 dev_dbg(&tz->device, "hwmon device lookup failed!\n"); 246 return; 247 } 248 249 temp = thermal_hwmon_lookup_temp(hwmon, tz); 250 if (unlikely(!temp)) { 251 /* Should never happen... */ 252 dev_dbg(&tz->device, "temperature input lookup failed!\n"); 253 return; 254 } 255 256 device_remove_file(hwmon->device, &temp->temp_input.attr); 257 if (thermal_zone_crit_temp_valid(tz)) 258 device_remove_file(hwmon->device, &temp->temp_crit.attr); 259 260 mutex_lock(&thermal_hwmon_list_lock); 261 list_del(&temp->hwmon_node); 262 kfree(temp); 263 if (!list_empty(&hwmon->tz_list)) { 264 mutex_unlock(&thermal_hwmon_list_lock); 265 return; 266 } 267 list_del(&hwmon->node); 268 mutex_unlock(&thermal_hwmon_list_lock); 269 270 device_remove_file(hwmon->device, &dev_attr_name); 271 hwmon_device_unregister(hwmon->device); 272 kfree(hwmon); 273 } 274 EXPORT_SYMBOL_GPL(thermal_remove_hwmon_sysfs); 275