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$");
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
45 static void fan_management_proc(void);
46 static void pmac_therm_manage_fans(void);
47
48 static struct proc *pmac_them_proc;
49 static int enable_pmac_thermal = 1;
50
51 static struct kproc_desc pmac_therm_kp = {
52 "pmac_thermal",
53 fan_management_proc,
54 &pmac_them_proc
55 };
56
57 SYSINIT(pmac_therm_setup, SI_SUB_KTHREAD_IDLE, SI_ORDER_ANY, kproc_start,
58 &pmac_therm_kp);
59 SYSCTL_INT(_machdep, OID_AUTO, manage_fans, CTLFLAG_RW | CTLFLAG_TUN,
60 &enable_pmac_thermal, 1, "Enable automatic fan management");
61 static MALLOC_DEFINE(M_PMACTHERM, "pmactherm", "Powermac Thermal Management");
62
63 struct pmac_fan_le {
64 struct pmac_fan *fan;
65 int last_val;
66 SLIST_ENTRY(pmac_fan_le) entries;
67 };
68 struct pmac_sens_le {
69 struct pmac_therm *sensor;
70 int last_val;
71 SLIST_ENTRY(pmac_sens_le) entries;
72 };
73 static SLIST_HEAD(pmac_fans, pmac_fan_le) fans = SLIST_HEAD_INITIALIZER(fans);
74 static SLIST_HEAD(pmac_sensors, pmac_sens_le) sensors =
75 SLIST_HEAD_INITIALIZER(sensors);
76
77 static void
78 fan_management_proc(void)
79 {
80 /* Nothing to manage? */
81 if (SLIST_EMPTY(&fans))
82 kproc_exit(0);
83
84 while (1) {
85 pmac_therm_manage_fans();
86 pause("pmac_therm", hz);
87 }
88 }
89
90 static void
91 pmac_therm_manage_fans(void)
92 {
93 struct pmac_sens_le *sensor;
94 struct pmac_fan_le *fan;
95 int average_excess, max_excess_zone, frac_excess;
96 int nsens, nsens_zone;
97 int temp;
98
99 if (!enable_pmac_thermal)
100 return;
101
102 /* Read all the sensors */
103 SLIST_FOREACH(sensor, &sensors, entries) {
104 temp = sensor->sensor->read(sensor->sensor);
105 if (temp > 0) /* Use the previous temp in case of error */
106 sensor->last_val = temp;
107
108 if (sensor->last_val > sensor->sensor->max_temp) {
109 printf("WARNING: Current temperature (%s: %d.%d C) "
110 "exceeds critical temperature (%d.%d C)! "
111 "Shutting down!\n", sensor->sensor->name,
112 (sensor->last_val - ZERO_C_TO_K) / 10,
113 (sensor->last_val - ZERO_C_TO_K) % 10,
114 (sensor->sensor->max_temp - ZERO_C_TO_K) / 10,
115 (sensor->sensor->max_temp - ZERO_C_TO_K) % 10);
116 shutdown_nice(RB_POWEROFF);
117 }
118 }
119
120 /* Set all the fans */
121 SLIST_FOREACH(fan, &fans, entries) {
122 nsens = nsens_zone = 0;
123 average_excess = max_excess_zone = 0;
124 SLIST_FOREACH(sensor, &sensors, entries) {
125 frac_excess = (sensor->last_val -
126 sensor->sensor->target_temp)*100 /
127 (sensor->sensor->max_temp -
128 sensor->sensor->target_temp);
129 if (frac_excess < 0)
130 frac_excess = 0;
131 if (sensor->sensor->zone == fan->fan->zone) {
132 max_excess_zone = imax(max_excess_zone,
133 frac_excess);
134 nsens_zone++;
135 }
136 average_excess += frac_excess;
137 nsens++;
138 }
139 average_excess /= nsens;
140
141 /* If there are no sensors in this zone, use the average */
142 if (nsens_zone == 0)
143 max_excess_zone = average_excess;
144 /* No sensors at all? Use default */
145 if (nsens == 0) {
146 fan->fan->set(fan->fan, fan->fan->default_rpm);
147 continue;
148 }
149
150 /*
151 * Scale the fan linearly in the max temperature in its
152 * thermal zone.
153 */
154 fan->fan->set(fan->fan, max_excess_zone *
155 (fan->fan->max_rpm - fan->fan->min_rpm)/100 +
156 fan->fan->min_rpm);
157 }
158 }
159
160 void
161 pmac_thermal_fan_register(struct pmac_fan *fan)
162 {
163 struct pmac_fan_le *list_entry;
164
165 list_entry = malloc(sizeof(struct pmac_fan_le), M_PMACTHERM,
166 M_ZERO | M_WAITOK);
167 list_entry->fan = fan;
168
169 SLIST_INSERT_HEAD(&fans, list_entry, entries);
170 }
171
172 void
173 pmac_thermal_sensor_register(struct pmac_therm *sensor)
174 {
175 struct pmac_sens_le *list_entry;
176
177 list_entry = malloc(sizeof(struct pmac_sens_le), M_PMACTHERM,
178 M_ZERO | M_WAITOK);
179 list_entry->sensor = sensor;
180
181 SLIST_INSERT_HEAD(&sensors, list_entry, entries);
182 }
183
Cache object: e5d34e338b1dedea1e939c461dba1fa3
|