Home | History | Annotate | Line # | Download | only in dev 
      1 /* $NetBSD: fancontrol.c,v 1.3 2021/07/30 22:07:14 macallan Exp $ */
      2 
      3 /*-
      4  * Copyright (c) 2021 Michael Lorenz
      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 NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     17  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     18  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     19  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     20  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     21  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     22  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     23  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     24  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     25  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     26  * POSSIBILITY OF SUCH DAMAGE.
     27  */
     28 
     29 #include <sys/cdefs.h>
     30 __KERNEL_RCSID(0, "$NetBSD: fancontrol.c,v 1.3 2021/07/30 22:07:14 macallan Exp $");
     31 
     32 #include <sys/param.h>
     33 #include <sys/systm.h>
     34 #include <sys/device.h>
     35 #include <sys/conf.h>
     36 #include <sys/bus.h>
     37 #include <sys/sysctl.h>
     38 #include <dev/sysmon/sysmonvar.h>
     39 
     40 #include <macppc/dev/fancontrolvar.h>
     41 #include "opt_fancontrol.h"
     42 
     43 #ifdef FANCONTROL_DEBUG
     44 #define DPRINTF printf
     45 #else
     46 #define DPRINTF while (0) printf
     47 #endif
     48 
     49 int
     50 fancontrol_adjust_zone(fancontrol_zone_t *z)
     51 {
     52 	int temp, i, speed, diff, step;
     53 
     54 	if (z->nfans <= 0)
     55 		return -1;
     56 
     57 	temp = sysmon_envsys_get_max_value(z->filter, true);
     58 	if (temp == 0) {
     59 		/* no sensor data - leave fan alone */
     60 		DPRINTF("nodata\n");
     61 		return -1;
     62 	}
     63 
     64 	if (z->Tmin < 30) z->Tmin = 30;
     65 	if (z->Tmin > 60) z->Tmin = 60;
     66 	if (z->Tmax > 95) z->Tmax = 95;
     67 	if (z->Tmax < (z->Tmin + 10)) z->Tmax = z->Tmin + 10;
     68 	temp = (temp - 273150000) / 1000000;
     69 	diff = temp - z->Tmin;
     70 	DPRINTF("%s %d %d\n", z->name, temp, z->Tmin);
     71 	if (diff < 0) diff = 0;
     72 	diff = (100 * diff) / (z->Tmax - z->Tmin);
     73 
     74 	/* now adjust each fan to the new speed */
     75 	for (i = 0; i < z->nfans; i++) {
     76 		step = (z->fans[i].max_rpm - z->fans[i].min_rpm) / 100;
     77 		speed = z->fans[i].min_rpm + diff * step;
     78 		DPRINTF("diff %d base %d %d sp %d\n",
     79 		    diff, z->fans[i].min_rpm, z->fans[i].max_rpm, speed);
     80 		z->set_rpm(z->cookie, z->fans[i].num, speed);
     81 	}
     82 	return 0;
     83 }
     84 
     85 int
     86 fancontrol_init_zone(fancontrol_zone_t *z, struct sysctlnode *me)
     87 {
     88 	struct sysctlnode *zone_node, *node;
     89 
     90 	if (z->nfans <= 0) return 0;
     91 
     92 	sysctl_createv(NULL, 0, NULL, (void *) &zone_node,
     93 	    CTLFLAG_READWRITE | CTLFLAG_OWNDESC,
     94 	    CTLTYPE_NODE, z->name, NULL,
     95 	    NULL, 0, NULL, 0,
     96 	    CTL_MACHDEP,
     97 	    me->sysctl_num,
     98 	    CTL_CREATE, CTL_EOL);
     99 
    100 	sysctl_createv(NULL, 0, NULL, (void *) &node,
    101 	    CTLFLAG_READWRITE | CTLFLAG_OWNDESC,
    102 	    CTLTYPE_INT, "Tmin", "minimum temperature",
    103 	    NULL, 0, (void *)&z->Tmin, 0,
    104 	    CTL_MACHDEP,
    105 	    me->sysctl_num,
    106 	    zone_node->sysctl_num,
    107 	    CTL_CREATE, CTL_EOL);
    108 
    109 	sysctl_createv(NULL, 0, NULL, (void *) &node,
    110 	    CTLFLAG_READWRITE | CTLFLAG_OWNDESC,
    111 	    CTLTYPE_INT, "Tmax", "maximum temperature",
    112 	    NULL, 0, (void *)&z->Tmax, 0,
    113 	    CTL_MACHDEP,
    114 	    me->sysctl_num,
    115 	    zone_node->sysctl_num,
    116 	    CTL_CREATE, CTL_EOL);
    117 
    118 	return 0;
    119 }
    120