1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * Windfarm PowerMac thermal control. Core 4 * 5 * (c) Copyright 2005 Benjamin Herrenschmidt, IBM Corp. 6 * <benh@kernel.crashing.org> 7 * 8 * This core code tracks the list of sensors & controls, register 9 * clients, and holds the kernel thread used for control. 10 * 11 * TODO: 12 * 13 * Add some information about sensor/control type and data format to 14 * sensors/controls, and have the sysfs attribute stuff be moved 15 * generically here instead of hard coded in the platform specific 16 * driver as it us currently 17 * 18 * This however requires solving some annoying lifetime issues with 19 * sysfs which doesn't seem to have lifetime rules for struct attribute, 20 * I may have to create full features kobjects for every sensor/control 21 * instead which is a bit of an overkill imho 22 */ 23 24 #include <linux/types.h> 25 #include <linux/errno.h> 26 #include <linux/kernel.h> 27 #include <linux/slab.h> 28 #include <linux/init.h> 29 #include <linux/spinlock.h> 30 #include <linux/kthread.h> 31 #include <linux/jiffies.h> 32 #include <linux/reboot.h> 33 #include <linux/device.h> 34 #include <linux/platform_device.h> 35 #include <linux/mutex.h> 36 #include <linux/freezer.h> 37 38 #include <asm/prom.h> 39 40 #include "windfarm.h" 41 42 #define VERSION "0.2" 43 44 #undef DEBUG 45 46 #ifdef DEBUG 47 #define DBG(args...) printk(args) 48 #else 49 #define DBG(args...) do { } while(0) 50 #endif 51 52 static LIST_HEAD(wf_controls); 53 static LIST_HEAD(wf_sensors); 54 static DEFINE_MUTEX(wf_lock); 55 static BLOCKING_NOTIFIER_HEAD(wf_client_list); 56 static int wf_client_count; 57 static unsigned int wf_overtemp; 58 static unsigned int wf_overtemp_counter; 59 struct task_struct *wf_thread; 60 61 static struct platform_device wf_platform_device = { 62 .name = "windfarm", 63 }; 64 65 /* 66 * Utilities & tick thread 67 */ 68 69 static inline void wf_notify(int event, void *param) 70 { 71 blocking_notifier_call_chain(&wf_client_list, event, param); 72 } 73 74 static int wf_critical_overtemp(void) 75 { 76 static char const critical_overtemp_path[] = "/sbin/critical_overtemp"; 77 char *argv[] = { (char *)critical_overtemp_path, NULL }; 78 static char *envp[] = { "HOME=/", 79 "TERM=linux", 80 "PATH=/sbin:/usr/sbin:/bin:/usr/bin", 81 NULL }; 82 83 return call_usermodehelper(critical_overtemp_path, 84 argv, envp, UMH_WAIT_EXEC); 85 } 86 87 static int wf_thread_func(void *data) 88 { 89 unsigned long next, delay; 90 91 next = jiffies; 92 93 DBG("wf: thread started\n"); 94 95 set_freezable(); 96 while (!kthread_should_stop()) { 97 try_to_freeze(); 98 99 if (time_after_eq(jiffies, next)) { 100 wf_notify(WF_EVENT_TICK, NULL); 101 if (wf_overtemp) { 102 wf_overtemp_counter++; 103 /* 10 seconds overtemp, notify userland */ 104 if (wf_overtemp_counter > 10) 105 wf_critical_overtemp(); 106 /* 30 seconds, shutdown */ 107 if (wf_overtemp_counter > 30) { 108 printk(KERN_ERR "windfarm: Overtemp " 109 "for more than 30" 110 " seconds, shutting down\n"); 111 machine_power_off(); 112 } 113 } 114 next += HZ; 115 } 116 117 delay = next - jiffies; 118 if (delay <= HZ) 119 schedule_timeout_interruptible(delay); 120 } 121 122 DBG("wf: thread stopped\n"); 123 124 return 0; 125 } 126 127 static void wf_start_thread(void) 128 { 129 wf_thread = kthread_run(wf_thread_func, NULL, "kwindfarm"); 130 if (IS_ERR(wf_thread)) { 131 printk(KERN_ERR "windfarm: failed to create thread,err %ld\n", 132 PTR_ERR(wf_thread)); 133 wf_thread = NULL; 134 } 135 } 136 137 138 static void wf_stop_thread(void) 139 { 140 if (wf_thread) 141 kthread_stop(wf_thread); 142 wf_thread = NULL; 143 } 144 145 /* 146 * Controls 147 */ 148 149 static void wf_control_release(struct kref *kref) 150 { 151 struct wf_control *ct = container_of(kref, struct wf_control, ref); 152 153 DBG("wf: Deleting control %s\n", ct->name); 154 155 if (ct->ops && ct->ops->release) 156 ct->ops->release(ct); 157 else 158 kfree(ct); 159 } 160 161 static ssize_t wf_show_control(struct device *dev, 162 struct device_attribute *attr, char *buf) 163 { 164 struct wf_control *ctrl = container_of(attr, struct wf_control, attr); 165 const char *typestr; 166 s32 val = 0; 167 int err; 168 169 err = ctrl->ops->get_value(ctrl, &val); 170 if (err < 0) { 171 if (err == -EFAULT) 172 return sprintf(buf, "<HW FAULT>\n"); 173 return err; 174 } 175 switch(ctrl->type) { 176 case WF_CONTROL_RPM_FAN: 177 typestr = " RPM"; 178 break; 179 case WF_CONTROL_PWM_FAN: 180 typestr = " %"; 181 break; 182 default: 183 typestr = ""; 184 } 185 return sprintf(buf, "%d%s\n", val, typestr); 186 } 187 188 /* This is really only for debugging... */ 189 static ssize_t wf_store_control(struct device *dev, 190 struct device_attribute *attr, 191 const char *buf, size_t count) 192 { 193 struct wf_control *ctrl = container_of(attr, struct wf_control, attr); 194 int val; 195 int err; 196 char *endp; 197 198 val = simple_strtoul(buf, &endp, 0); 199 while (endp < buf + count && (*endp == ' ' || *endp == '\n')) 200 ++endp; 201 if (endp - buf < count) 202 return -EINVAL; 203 err = ctrl->ops->set_value(ctrl, val); 204 if (err < 0) 205 return err; 206 return count; 207 } 208 209 int wf_register_control(struct wf_control *new_ct) 210 { 211 struct wf_control *ct; 212 213 mutex_lock(&wf_lock); 214 list_for_each_entry(ct, &wf_controls, link) { 215 if (!strcmp(ct->name, new_ct->name)) { 216 printk(KERN_WARNING "windfarm: trying to register" 217 " duplicate control %s\n", ct->name); 218 mutex_unlock(&wf_lock); 219 return -EEXIST; 220 } 221 } 222 kref_init(&new_ct->ref); 223 list_add(&new_ct->link, &wf_controls); 224 225 sysfs_attr_init(&new_ct->attr.attr); 226 new_ct->attr.attr.name = new_ct->name; 227 new_ct->attr.attr.mode = 0644; 228 new_ct->attr.show = wf_show_control; 229 new_ct->attr.store = wf_store_control; 230 if (device_create_file(&wf_platform_device.dev, &new_ct->attr)) 231 printk(KERN_WARNING "windfarm: device_create_file failed" 232 " for %s\n", new_ct->name); 233 /* the subsystem still does useful work without the file */ 234 235 DBG("wf: Registered control %s\n", new_ct->name); 236 237 wf_notify(WF_EVENT_NEW_CONTROL, new_ct); 238 mutex_unlock(&wf_lock); 239 240 return 0; 241 } 242 EXPORT_SYMBOL_GPL(wf_register_control); 243 244 void wf_unregister_control(struct wf_control *ct) 245 { 246 mutex_lock(&wf_lock); 247 list_del(&ct->link); 248 mutex_unlock(&wf_lock); 249 250 DBG("wf: Unregistered control %s\n", ct->name); 251 252 kref_put(&ct->ref, wf_control_release); 253 } 254 EXPORT_SYMBOL_GPL(wf_unregister_control); 255 256 int wf_get_control(struct wf_control *ct) 257 { 258 if (!try_module_get(ct->ops->owner)) 259 return -ENODEV; 260 kref_get(&ct->ref); 261 return 0; 262 } 263 EXPORT_SYMBOL_GPL(wf_get_control); 264 265 void wf_put_control(struct wf_control *ct) 266 { 267 struct module *mod = ct->ops->owner; 268 kref_put(&ct->ref, wf_control_release); 269 module_put(mod); 270 } 271 EXPORT_SYMBOL_GPL(wf_put_control); 272 273 274 /* 275 * Sensors 276 */ 277 278 279 static void wf_sensor_release(struct kref *kref) 280 { 281 struct wf_sensor *sr = container_of(kref, struct wf_sensor, ref); 282 283 DBG("wf: Deleting sensor %s\n", sr->name); 284 285 if (sr->ops && sr->ops->release) 286 sr->ops->release(sr); 287 else 288 kfree(sr); 289 } 290 291 static ssize_t wf_show_sensor(struct device *dev, 292 struct device_attribute *attr, char *buf) 293 { 294 struct wf_sensor *sens = container_of(attr, struct wf_sensor, attr); 295 s32 val = 0; 296 int err; 297 298 err = sens->ops->get_value(sens, &val); 299 if (err < 0) 300 return err; 301 return sprintf(buf, "%d.%03d\n", FIX32TOPRINT(val)); 302 } 303 304 int wf_register_sensor(struct wf_sensor *new_sr) 305 { 306 struct wf_sensor *sr; 307 308 mutex_lock(&wf_lock); 309 list_for_each_entry(sr, &wf_sensors, link) { 310 if (!strcmp(sr->name, new_sr->name)) { 311 printk(KERN_WARNING "windfarm: trying to register" 312 " duplicate sensor %s\n", sr->name); 313 mutex_unlock(&wf_lock); 314 return -EEXIST; 315 } 316 } 317 kref_init(&new_sr->ref); 318 list_add(&new_sr->link, &wf_sensors); 319 320 sysfs_attr_init(&new_sr->attr.attr); 321 new_sr->attr.attr.name = new_sr->name; 322 new_sr->attr.attr.mode = 0444; 323 new_sr->attr.show = wf_show_sensor; 324 new_sr->attr.store = NULL; 325 if (device_create_file(&wf_platform_device.dev, &new_sr->attr)) 326 printk(KERN_WARNING "windfarm: device_create_file failed" 327 " for %s\n", new_sr->name); 328 /* the subsystem still does useful work without the file */ 329 330 DBG("wf: Registered sensor %s\n", new_sr->name); 331 332 wf_notify(WF_EVENT_NEW_SENSOR, new_sr); 333 mutex_unlock(&wf_lock); 334 335 return 0; 336 } 337 EXPORT_SYMBOL_GPL(wf_register_sensor); 338 339 void wf_unregister_sensor(struct wf_sensor *sr) 340 { 341 mutex_lock(&wf_lock); 342 list_del(&sr->link); 343 mutex_unlock(&wf_lock); 344 345 DBG("wf: Unregistered sensor %s\n", sr->name); 346 347 wf_put_sensor(sr); 348 } 349 EXPORT_SYMBOL_GPL(wf_unregister_sensor); 350 351 int wf_get_sensor(struct wf_sensor *sr) 352 { 353 if (!try_module_get(sr->ops->owner)) 354 return -ENODEV; 355 kref_get(&sr->ref); 356 return 0; 357 } 358 EXPORT_SYMBOL_GPL(wf_get_sensor); 359 360 void wf_put_sensor(struct wf_sensor *sr) 361 { 362 struct module *mod = sr->ops->owner; 363 kref_put(&sr->ref, wf_sensor_release); 364 module_put(mod); 365 } 366 EXPORT_SYMBOL_GPL(wf_put_sensor); 367 368 369 /* 370 * Client & notification 371 */ 372 373 int wf_register_client(struct notifier_block *nb) 374 { 375 int rc; 376 struct wf_control *ct; 377 struct wf_sensor *sr; 378 379 mutex_lock(&wf_lock); 380 rc = blocking_notifier_chain_register(&wf_client_list, nb); 381 if (rc != 0) 382 goto bail; 383 wf_client_count++; 384 list_for_each_entry(ct, &wf_controls, link) 385 wf_notify(WF_EVENT_NEW_CONTROL, ct); 386 list_for_each_entry(sr, &wf_sensors, link) 387 wf_notify(WF_EVENT_NEW_SENSOR, sr); 388 if (wf_client_count == 1) 389 wf_start_thread(); 390 bail: 391 mutex_unlock(&wf_lock); 392 return rc; 393 } 394 EXPORT_SYMBOL_GPL(wf_register_client); 395 396 int wf_unregister_client(struct notifier_block *nb) 397 { 398 mutex_lock(&wf_lock); 399 blocking_notifier_chain_unregister(&wf_client_list, nb); 400 wf_client_count--; 401 if (wf_client_count == 0) 402 wf_stop_thread(); 403 mutex_unlock(&wf_lock); 404 405 return 0; 406 } 407 EXPORT_SYMBOL_GPL(wf_unregister_client); 408 409 void wf_set_overtemp(void) 410 { 411 mutex_lock(&wf_lock); 412 wf_overtemp++; 413 if (wf_overtemp == 1) { 414 printk(KERN_WARNING "windfarm: Overtemp condition detected !\n"); 415 wf_overtemp_counter = 0; 416 wf_notify(WF_EVENT_OVERTEMP, NULL); 417 } 418 mutex_unlock(&wf_lock); 419 } 420 EXPORT_SYMBOL_GPL(wf_set_overtemp); 421 422 void wf_clear_overtemp(void) 423 { 424 mutex_lock(&wf_lock); 425 WARN_ON(wf_overtemp == 0); 426 if (wf_overtemp == 0) { 427 mutex_unlock(&wf_lock); 428 return; 429 } 430 wf_overtemp--; 431 if (wf_overtemp == 0) { 432 printk(KERN_WARNING "windfarm: Overtemp condition cleared !\n"); 433 wf_notify(WF_EVENT_NORMALTEMP, NULL); 434 } 435 mutex_unlock(&wf_lock); 436 } 437 EXPORT_SYMBOL_GPL(wf_clear_overtemp); 438 439 static int __init windfarm_core_init(void) 440 { 441 DBG("wf: core loaded\n"); 442 443 platform_device_register(&wf_platform_device); 444 return 0; 445 } 446 447 static void __exit windfarm_core_exit(void) 448 { 449 BUG_ON(wf_client_count != 0); 450 451 DBG("wf: core unloaded\n"); 452 453 platform_device_unregister(&wf_platform_device); 454 } 455 456 457 module_init(windfarm_core_init); 458 module_exit(windfarm_core_exit); 459 460 MODULE_AUTHOR("Benjamin Herrenschmidt <benh@kernel.crashing.org>"); 461 MODULE_DESCRIPTION("Core component of PowerMac thermal control"); 462 MODULE_LICENSE("GPL"); 463 464