tda.c revision 1.3.2.3
1 1.3.2.3 yamt /* $NetBSD: tda.c,v 1.3.2.3 2010/08/11 22:52:47 yamt Exp $ */ 2 1.3.2.2 yamt /* $OpenBSD: tda.c,v 1.4 2008/02/27 17:25:00 robert Exp $ */ 3 1.3.2.2 yamt 4 1.3.2.2 yamt /* 5 1.3.2.2 yamt * Copyright (c) 2008 Robert Nagy <robert (at) openbsd.org> 6 1.3.2.2 yamt * Copyright (c) 2008 Mark Kettenis <kettenis (at) openbsd.org> 7 1.3.2.2 yamt * 8 1.3.2.2 yamt * Permission to use, copy, modify, and distribute this software for any 9 1.3.2.2 yamt * purpose with or without fee is hereby granted, provided that the above 10 1.3.2.2 yamt * copyright notice and this permission notice appear in all copies. 11 1.3.2.2 yamt * 12 1.3.2.2 yamt * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 13 1.3.2.2 yamt * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 14 1.3.2.2 yamt * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 15 1.3.2.2 yamt * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 16 1.3.2.2 yamt * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 17 1.3.2.2 yamt * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 18 1.3.2.2 yamt * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 19 1.3.2.2 yamt */ 20 1.3.2.2 yamt 21 1.3.2.2 yamt #include <sys/param.h> 22 1.3.2.2 yamt #include <sys/systm.h> 23 1.3.2.2 yamt #include <sys/kernel.h> 24 1.3.2.2 yamt #include <sys/device.h> 25 1.3.2.2 yamt #include <dev/sysmon/sysmonvar.h> 26 1.3.2.2 yamt #include <dev/sysmon/sysmon_taskq.h> 27 1.3.2.2 yamt 28 1.3.2.2 yamt #include <machine/autoconf.h> 29 1.3.2.2 yamt #include <machine/openfirm.h> 30 1.3.2.2 yamt 31 1.3.2.2 yamt #include <dev/i2c/i2cvar.h> 32 1.3.2.2 yamt 33 1.3.2.2 yamt /* fan control registers */ 34 1.3.2.2 yamt #define TDA_SYSFAN_REG 0xf0 35 1.3.2.2 yamt #define TDA_CPUFAN_REG 0xf2 36 1.3.2.2 yamt #define TDA_PSFAN_REG 0xf4 37 1.3.2.2 yamt 38 1.3.2.2 yamt #define TDA_FANSPEED_MIN 0x0c 39 1.3.2.2 yamt #define TDA_FANSPEED_MAX 0x3f 40 1.3.2.2 yamt 41 1.3.2.2 yamt #define TDA_PSFAN_ON 0x1f 42 1.3.2.2 yamt #define TDA_PSFAN_OFF 0x00 43 1.3.2.2 yamt 44 1.3.2.2 yamt /* Internal and External temperature senor numbers */ 45 1.3.2.2 yamt #define SENSOR_TEMP_EXT 0 46 1.3.2.2 yamt #define SENSOR_TEMP_INT 1 47 1.3.2.2 yamt 48 1.3.2.2 yamt #define CPU_TEMP_MAX (67 * 1000000 + 273150000) 49 1.3.2.2 yamt #define CPU_TEMP_MIN (57 * 1000000 + 273150000) 50 1.3.2.2 yamt #define SYS_TEMP_MAX (30 * 1000000 + 273150000) 51 1.3.2.2 yamt #define SYS_TEMP_MIN (20 * 1000000 + 273150000) 52 1.3.2.2 yamt 53 1.3.2.2 yamt struct tda_softc { 54 1.3.2.2 yamt device_t sc_dev; 55 1.3.2.2 yamt i2c_tag_t sc_tag; 56 1.3.2.2 yamt i2c_addr_t sc_addr; 57 1.3.2.2 yamt 58 1.3.2.2 yamt u_int16_t sc_cfan_speed; /* current CPU fan speed */ 59 1.3.2.2 yamt u_int16_t sc_sfan_speed; /* current SYS fan speed */ 60 1.3.2.2 yamt 61 1.3.2.2 yamt callout_t sc_timer; 62 1.3.2.2 yamt }; 63 1.3.2.2 yamt 64 1.3.2.2 yamt int tda_match(struct device *, struct cfdata *, void *); 65 1.3.2.2 yamt void tda_attach(struct device *, struct device *, void *); 66 1.3.2.2 yamt 67 1.3.2.2 yamt void tda_setspeed(struct tda_softc *); 68 1.3.2.2 yamt static void tda_adjust(void *); 69 1.3.2.2 yamt static void tda_timeout(void *); 70 1.3.2.2 yamt 71 1.3.2.2 yamt 72 1.3.2.2 yamt CFATTACH_DECL_NEW(tda, sizeof(struct tda_softc), 73 1.3.2.2 yamt tda_match, tda_attach, NULL, NULL); 74 1.3.2.2 yamt 75 1.3.2.2 yamt int 76 1.3.2.2 yamt tda_match(struct device *parent, struct cfdata *match, void *aux) 77 1.3.2.2 yamt { 78 1.3.2.2 yamt struct i2c_attach_args *ia = aux; 79 1.3.2.2 yamt char name[32]; 80 1.3.2.2 yamt 81 1.3.2.2 yamt /* Only attach on the Sun Blade 1000/2000. */ 82 1.3.2.2 yamt if (OF_getprop(findroot(), "name", name, sizeof(name)) <= 0) 83 1.3.2.2 yamt return (0); 84 1.3.2.2 yamt if (strcmp(name, "SUNW,Sun-Blade-1000") != 0) 85 1.3.2.2 yamt return (0); 86 1.3.2.2 yamt 87 1.3.2.2 yamt /* 88 1.3.2.2 yamt * No need for "compatible" matching, we know exactly what 89 1.3.2.2 yamt * firmware calls us. 90 1.3.2.2 yamt */ 91 1.3.2.2 yamt return strcmp(ia->ia_name, "fan-control") == 0; 92 1.3.2.2 yamt } 93 1.3.2.2 yamt 94 1.3.2.2 yamt void 95 1.3.2.2 yamt tda_attach(struct device *parent, struct device *self, void *aux) 96 1.3.2.2 yamt { 97 1.3.2.2 yamt struct tda_softc *sc = device_private(self); 98 1.3.2.2 yamt struct i2c_attach_args *ia = aux; 99 1.3.2.2 yamt 100 1.3.2.2 yamt sc->sc_dev = self; 101 1.3.2.2 yamt sc->sc_tag = ia->ia_tag; 102 1.3.2.2 yamt sc->sc_addr = ia->ia_addr; 103 1.3.2.2 yamt 104 1.3.2.2 yamt aprint_normal(": %s\n", ia->ia_name); 105 1.3.2.3 yamt aprint_naive(": Environment sensor\n"); 106 1.3.2.2 yamt 107 1.3.2.2 yamt /* 108 1.3.2.2 yamt * Set the fans to maximum speed and save the power levels; 109 1.3.2.2 yamt * the controller is write-only. 110 1.3.2.2 yamt */ 111 1.3.2.2 yamt sc->sc_cfan_speed = sc->sc_sfan_speed = (TDA_FANSPEED_MAX+TDA_FANSPEED_MIN)/2; 112 1.3.2.2 yamt tda_setspeed(sc); 113 1.3.2.2 yamt 114 1.3.2.2 yamt callout_init(&sc->sc_timer, CALLOUT_MPSAFE); 115 1.3.2.2 yamt callout_reset(&sc->sc_timer, hz*20, tda_timeout, sc); 116 1.3.2.2 yamt } 117 1.3.2.2 yamt 118 1.3.2.2 yamt static void 119 1.3.2.2 yamt tda_timeout(void *v) 120 1.3.2.2 yamt { 121 1.3.2.2 yamt struct tda_softc *sc = v; 122 1.3.2.2 yamt 123 1.3.2.2 yamt sysmon_task_queue_sched(0, tda_adjust, sc); 124 1.3.2.2 yamt callout_reset(&sc->sc_timer, hz*60, tda_timeout, sc); 125 1.3.2.2 yamt } 126 1.3.2.2 yamt 127 1.3.2.2 yamt void 128 1.3.2.2 yamt tda_setspeed(struct tda_softc *sc) 129 1.3.2.2 yamt { 130 1.3.2.2 yamt u_int8_t cmd[2]; 131 1.3.2.2 yamt 132 1.3.2.2 yamt if (sc->sc_cfan_speed < TDA_FANSPEED_MIN) 133 1.3.2.2 yamt sc->sc_cfan_speed = TDA_FANSPEED_MIN; 134 1.3.2.2 yamt if (sc->sc_sfan_speed < TDA_FANSPEED_MIN) 135 1.3.2.2 yamt sc->sc_sfan_speed = TDA_FANSPEED_MIN; 136 1.3.2.2 yamt if (sc->sc_cfan_speed > TDA_FANSPEED_MAX) 137 1.3.2.2 yamt sc->sc_cfan_speed = TDA_FANSPEED_MAX; 138 1.3.2.2 yamt if (sc->sc_sfan_speed > TDA_FANSPEED_MAX) 139 1.3.2.2 yamt sc->sc_sfan_speed = TDA_FANSPEED_MAX; 140 1.3.2.2 yamt 141 1.3.2.2 yamt iic_acquire_bus(sc->sc_tag, 0); 142 1.3.2.2 yamt 143 1.3.2.2 yamt cmd[0] = TDA_CPUFAN_REG; 144 1.3.2.2 yamt cmd[1] = sc->sc_cfan_speed; 145 1.3.2.2 yamt if (iic_exec(sc->sc_tag, I2C_OP_WRITE_WITH_STOP, 146 1.3.2.2 yamt sc->sc_addr, &cmd, sizeof(cmd), NULL, 0, 0)) { 147 1.3.2.2 yamt aprint_error_dev(sc->sc_dev, "cannot write cpu-fan register\n"); 148 1.3.2.2 yamt iic_release_bus(sc->sc_tag, 0); 149 1.3.2.2 yamt return; 150 1.3.2.2 yamt } 151 1.3.2.2 yamt 152 1.3.2.2 yamt cmd[0] = TDA_SYSFAN_REG; 153 1.3.2.2 yamt cmd[1] = sc->sc_sfan_speed; 154 1.3.2.2 yamt if (iic_exec(sc->sc_tag, I2C_OP_WRITE_WITH_STOP, 155 1.3.2.2 yamt sc->sc_addr, &cmd, sizeof(cmd), NULL, 0, 0)) { 156 1.3.2.2 yamt aprint_error_dev(sc->sc_dev, "cannot write system-fan register\n"); 157 1.3.2.2 yamt iic_release_bus(sc->sc_tag, 0); 158 1.3.2.2 yamt return; 159 1.3.2.2 yamt } 160 1.3.2.2 yamt 161 1.3.2.2 yamt iic_release_bus(sc->sc_tag, 0); 162 1.3.2.2 yamt 163 1.3.2.2 yamt aprint_debug_dev(sc->sc_dev, "changed fan speed to cpu=%d system=%d\n", 164 1.3.2.2 yamt sc->sc_cfan_speed, sc->sc_sfan_speed); 165 1.3.2.2 yamt } 166 1.3.2.2 yamt 167 1.3.2.2 yamt static bool 168 1.3.2.2 yamt is_cpu_sensor(const envsys_data_t *edata) 169 1.3.2.2 yamt { 170 1.3.2.2 yamt if (edata->units != ENVSYS_STEMP) 171 1.3.2.2 yamt return false; 172 1.3.2.2 yamt return strcmp(edata->desc, "external") == 0; 173 1.3.2.2 yamt } 174 1.3.2.2 yamt 175 1.3.2.2 yamt static bool 176 1.3.2.2 yamt is_system_sensor(const envsys_data_t *edata) 177 1.3.2.2 yamt { 178 1.3.2.2 yamt if (edata->units != ENVSYS_STEMP) 179 1.3.2.2 yamt return false; 180 1.3.2.2 yamt return strcmp(edata->desc, "internal") == 0; 181 1.3.2.2 yamt } 182 1.3.2.2 yamt 183 1.3.2.2 yamt static void 184 1.3.2.2 yamt tda_adjust(void *v) 185 1.3.2.2 yamt { 186 1.3.2.2 yamt struct tda_softc *sc = v; 187 1.3.2.2 yamt u_int64_t ctemp, stemp; 188 1.3.2.2 yamt u_int16_t cspeed, sspeed; 189 1.3.2.2 yamt 190 1.3.2.2 yamt /* Default to running the fans at maximum speed. */ 191 1.3.2.2 yamt sspeed = cspeed = TDA_FANSPEED_MAX; 192 1.3.2.2 yamt 193 1.3.2.2 yamt /* fetch maximum current temperature */ 194 1.3.2.2 yamt ctemp = sysmon_envsys_get_max_value(is_cpu_sensor, true); 195 1.3.2.2 yamt stemp = sysmon_envsys_get_max_value(is_system_sensor, true); 196 1.3.2.2 yamt 197 1.3.2.2 yamt /* the predicates for selecting sensors must have gone wrong */ 198 1.3.2.2 yamt if (ctemp == 0 || stemp == 0) { 199 1.3.2.2 yamt aprint_error_dev(sc->sc_dev, "skipping temp adjustment" 200 1.3.2.2 yamt " - no sensor values\n"); 201 1.3.2.2 yamt return; 202 1.3.2.2 yamt } 203 1.3.2.2 yamt 204 1.3.2.2 yamt aprint_debug_dev(sc->sc_dev, "current temperature: cpu %" PRIu64 205 1.3.2.2 yamt " system %" PRIu64 "\n", 206 1.3.2.2 yamt ctemp, stemp); 207 1.3.2.2 yamt 208 1.3.2.2 yamt if (ctemp < CPU_TEMP_MIN) 209 1.3.2.2 yamt cspeed = TDA_FANSPEED_MIN; 210 1.3.2.2 yamt else if (ctemp < CPU_TEMP_MAX) 211 1.3.2.2 yamt cspeed = TDA_FANSPEED_MIN + 212 1.3.2.2 yamt (ctemp - CPU_TEMP_MIN) * 213 1.3.2.2 yamt (TDA_FANSPEED_MAX - TDA_FANSPEED_MIN) / 214 1.3.2.2 yamt (CPU_TEMP_MAX - CPU_TEMP_MIN); 215 1.3.2.2 yamt 216 1.3.2.2 yamt if (stemp < SYS_TEMP_MIN) 217 1.3.2.2 yamt sspeed = TDA_FANSPEED_MIN; 218 1.3.2.2 yamt else if (stemp < SYS_TEMP_MAX) 219 1.3.2.2 yamt sc->sc_sfan_speed = TDA_FANSPEED_MIN + 220 1.3.2.2 yamt (stemp - SYS_TEMP_MIN) * 221 1.3.2.2 yamt (TDA_FANSPEED_MAX - TDA_FANSPEED_MIN) / 222 1.3.2.2 yamt (SYS_TEMP_MAX - SYS_TEMP_MIN); 223 1.3.2.2 yamt 224 1.3.2.2 yamt if (sspeed == sc->sc_sfan_speed && cspeed == sc->sc_cfan_speed) 225 1.3.2.2 yamt return; 226 1.3.2.2 yamt 227 1.3.2.2 yamt sc->sc_sfan_speed = sspeed; 228 1.3.2.2 yamt sc->sc_cfan_speed = cspeed; 229 1.3.2.2 yamt tda_setspeed(sc); 230 1.3.2.2 yamt } 231
Indexes created Thu Oct 02 14:10:14 GMT 2025