sys/powerpc/powermac/powermac_thermal.c

   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