powermac_thermal.c revision 265970
1/*- 2 * Copyright (c) 2009-2011 Nathan Whitehorn 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 24 * SUCH DAMAGE. 25 */ 26 27#include <sys/cdefs.h> 28__FBSDID("$FreeBSD: stable/10/sys/powerpc/powermac/powermac_thermal.c 265970 2014-05-13 18:08:15Z ian $"); 29 30#include <sys/param.h> 31#include <sys/kernel.h> 32#include <sys/lock.h> 33#include <sys/mutex.h> 34#include <sys/systm.h> 35 36#include <sys/types.h> 37#include <sys/kthread.h> 38#include <sys/malloc.h> 39#include <sys/reboot.h> 40#include <sys/sysctl.h> 41#include <sys/queue.h> 42 43#include "powermac_thermal.h" 44 45static void fan_management_proc(void); 46static void pmac_therm_manage_fans(void); 47 48static struct proc *pmac_them_proc; 49static int enable_pmac_thermal = 1; 50 51static struct kproc_desc pmac_therm_kp = { 52 "pmac_thermal", 53 fan_management_proc, 54 &pmac_them_proc 55}; 56 57SYSINIT(pmac_therm_setup, SI_SUB_KTHREAD_IDLE, SI_ORDER_ANY, kproc_start, 58 &pmac_therm_kp); 59SYSCTL_INT(_machdep, OID_AUTO, manage_fans, CTLFLAG_RW | CTLFLAG_TUN, 60 &enable_pmac_thermal, 1, "Enable automatic fan management"); 61static MALLOC_DEFINE(M_PMACTHERM, "pmactherm", "Powermac Thermal Management"); 62 63struct pmac_fan_le { 64 struct pmac_fan *fan; 65 int last_val; 66 SLIST_ENTRY(pmac_fan_le) entries; 67}; 68struct pmac_sens_le { 69 struct pmac_therm *sensor; 70 int last_val; 71#define MAX_CRITICAL_COUNT 6 72 int critical_count; 73 SLIST_ENTRY(pmac_sens_le) entries; 74}; 75static SLIST_HEAD(pmac_fans, pmac_fan_le) fans = SLIST_HEAD_INITIALIZER(fans); 76static SLIST_HEAD(pmac_sensors, pmac_sens_le) sensors = 77 SLIST_HEAD_INITIALIZER(sensors); 78 79static void 80fan_management_proc(void) 81{ 82 /* Nothing to manage? */ 83 if (SLIST_EMPTY(&fans)) 84 kproc_exit(0); 85 86 while (1) { 87 pmac_therm_manage_fans(); 88 pause("pmac_therm", hz); 89 } 90} 91 92static void 93pmac_therm_manage_fans(void) 94{ 95 struct pmac_sens_le *sensor; 96 struct pmac_fan_le *fan; 97 int average_excess, max_excess_zone, frac_excess; 98 int nsens, nsens_zone; 99 int temp; 100 101 if (!enable_pmac_thermal) 102 return; 103 104 /* Read all the sensors */ 105 SLIST_FOREACH(sensor, &sensors, entries) { 106 temp = sensor->sensor->read(sensor->sensor); 107 if (temp > 0) /* Use the previous temp in case of error */ 108 sensor->last_val = temp; 109 110 if (sensor->last_val > sensor->sensor->max_temp) { 111 sensor->critical_count++; 112 printf("WARNING: Current temperature (%s: %d.%d C) " 113 "exceeds critical temperature (%d.%d C); " 114 "count=%d\n", 115 sensor->sensor->name, 116 (sensor->last_val - ZERO_C_TO_K) / 10, 117 (sensor->last_val - ZERO_C_TO_K) % 10, 118 (sensor->sensor->max_temp - ZERO_C_TO_K) / 10, 119 (sensor->sensor->max_temp - ZERO_C_TO_K) % 10, 120 sensor->critical_count); 121 if (sensor->critical_count >= MAX_CRITICAL_COUNT) { 122 printf("WARNING: %s temperature exceeded " 123 "critical temperature %d times in a row; " 124 "shutting down!\n", 125 sensor->sensor->name, 126 sensor->critical_count); 127 shutdown_nice(RB_POWEROFF); 128 } 129 } else { 130 if (sensor->critical_count > 0) 131 sensor->critical_count--; 132 } 133 } 134 135 /* Set all the fans */ 136 SLIST_FOREACH(fan, &fans, entries) { 137 nsens = nsens_zone = 0; 138 average_excess = max_excess_zone = 0; 139 SLIST_FOREACH(sensor, &sensors, entries) { 140 frac_excess = (sensor->last_val - 141 sensor->sensor->target_temp)*100 / 142 (sensor->sensor->max_temp - 143 sensor->sensor->target_temp); 144 if (frac_excess < 0) 145 frac_excess = 0; 146 if (sensor->sensor->zone == fan->fan->zone) { 147 max_excess_zone = imax(max_excess_zone, 148 frac_excess); 149 nsens_zone++; 150 } 151 average_excess += frac_excess; 152 nsens++; 153 } 154 average_excess /= nsens; 155 156 /* If there are no sensors in this zone, use the average */ 157 if (nsens_zone == 0) 158 max_excess_zone = average_excess; 159 /* No sensors at all? Use default */ 160 if (nsens == 0) { 161 fan->fan->set(fan->fan, fan->fan->default_rpm); 162 continue; 163 } 164 165 /* 166 * Scale the fan linearly in the max temperature in its 167 * thermal zone. 168 */ 169 fan->fan->set(fan->fan, max_excess_zone * 170 (fan->fan->max_rpm - fan->fan->min_rpm)/100 + 171 fan->fan->min_rpm); 172 } 173} 174 175void 176pmac_thermal_fan_register(struct pmac_fan *fan) 177{ 178 struct pmac_fan_le *list_entry; 179 180 list_entry = malloc(sizeof(struct pmac_fan_le), M_PMACTHERM, 181 M_ZERO | M_WAITOK); 182 list_entry->fan = fan; 183 184 SLIST_INSERT_HEAD(&fans, list_entry, entries); 185} 186 187void 188pmac_thermal_sensor_register(struct pmac_therm *sensor) 189{ 190 struct pmac_sens_le *list_entry; 191 192 list_entry = malloc(sizeof(struct pmac_sens_le), M_PMACTHERM, 193 M_ZERO | M_WAITOK); 194 list_entry->sensor = sensor; 195 list_entry->last_val = 0; 196 list_entry->critical_count = 0; 197 198 SLIST_INSERT_HEAD(&sensors, list_entry, entries); 199} 200 201