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