tda.c revision 1.3.2.2
1 1.3.2.2 yamt /* $NetBSD: tda.c,v 1.3.2.2 2010/03/11 15:03:00 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.2 yamt 106 1.3.2.2 yamt /* 107 1.3.2.2 yamt * Set the fans to maximum speed and save the power levels; 108 1.3.2.2 yamt * the controller is write-only. 109 1.3.2.2 yamt */ 110 1.3.2.2 yamt sc->sc_cfan_speed = sc->sc_sfan_speed = (TDA_FANSPEED_MAX+TDA_FANSPEED_MIN)/2; 111 1.3.2.2 yamt tda_setspeed(sc); 112 1.3.2.2 yamt 113 1.3.2.2 yamt callout_init(&sc->sc_timer, CALLOUT_MPSAFE); 114 1.3.2.2 yamt callout_reset(&sc->sc_timer, hz*20, tda_timeout, sc); 115 1.3.2.2 yamt } 116 1.3.2.2 yamt 117 1.3.2.2 yamt static void 118 1.3.2.2 yamt tda_timeout(void *v) 119 1.3.2.2 yamt { 120 1.3.2.2 yamt struct tda_softc *sc = v; 121 1.3.2.2 yamt 122 1.3.2.2 yamt sysmon_task_queue_sched(0, tda_adjust, sc); 123 1.3.2.2 yamt callout_reset(&sc->sc_timer, hz*60, tda_timeout, sc); 124 1.3.2.2 yamt } 125 1.3.2.2 yamt 126 1.3.2.2 yamt void 127 1.3.2.2 yamt tda_setspeed(struct tda_softc *sc) 128 1.3.2.2 yamt { 129 1.3.2.2 yamt u_int8_t cmd[2]; 130 1.3.2.2 yamt 131 1.3.2.2 yamt if (sc->sc_cfan_speed < TDA_FANSPEED_MIN) 132 1.3.2.2 yamt sc->sc_cfan_speed = TDA_FANSPEED_MIN; 133 1.3.2.2 yamt if (sc->sc_sfan_speed < TDA_FANSPEED_MIN) 134 1.3.2.2 yamt sc->sc_sfan_speed = TDA_FANSPEED_MIN; 135 1.3.2.2 yamt if (sc->sc_cfan_speed > TDA_FANSPEED_MAX) 136 1.3.2.2 yamt sc->sc_cfan_speed = TDA_FANSPEED_MAX; 137 1.3.2.2 yamt if (sc->sc_sfan_speed > TDA_FANSPEED_MAX) 138 1.3.2.2 yamt sc->sc_sfan_speed = TDA_FANSPEED_MAX; 139 1.3.2.2 yamt 140 1.3.2.2 yamt iic_acquire_bus(sc->sc_tag, 0); 141 1.3.2.2 yamt 142 1.3.2.2 yamt cmd[0] = TDA_CPUFAN_REG; 143 1.3.2.2 yamt cmd[1] = sc->sc_cfan_speed; 144 1.3.2.2 yamt if (iic_exec(sc->sc_tag, I2C_OP_WRITE_WITH_STOP, 145 1.3.2.2 yamt sc->sc_addr, &cmd, sizeof(cmd), NULL, 0, 0)) { 146 1.3.2.2 yamt aprint_error_dev(sc->sc_dev, "cannot write cpu-fan register\n"); 147 1.3.2.2 yamt iic_release_bus(sc->sc_tag, 0); 148 1.3.2.2 yamt return; 149 1.3.2.2 yamt } 150 1.3.2.2 yamt 151 1.3.2.2 yamt cmd[0] = TDA_SYSFAN_REG; 152 1.3.2.2 yamt cmd[1] = sc->sc_sfan_speed; 153 1.3.2.2 yamt if (iic_exec(sc->sc_tag, I2C_OP_WRITE_WITH_STOP, 154 1.3.2.2 yamt sc->sc_addr, &cmd, sizeof(cmd), NULL, 0, 0)) { 155 1.3.2.2 yamt aprint_error_dev(sc->sc_dev, "cannot write system-fan register\n"); 156 1.3.2.2 yamt iic_release_bus(sc->sc_tag, 0); 157 1.3.2.2 yamt return; 158 1.3.2.2 yamt } 159 1.3.2.2 yamt 160 1.3.2.2 yamt iic_release_bus(sc->sc_tag, 0); 161 1.3.2.2 yamt 162 1.3.2.2 yamt aprint_debug_dev(sc->sc_dev, "changed fan speed to cpu=%d system=%d\n", 163 1.3.2.2 yamt sc->sc_cfan_speed, sc->sc_sfan_speed); 164 1.3.2.2 yamt } 165 1.3.2.2 yamt 166 1.3.2.2 yamt static bool 167 1.3.2.2 yamt is_cpu_sensor(const envsys_data_t *edata) 168 1.3.2.2 yamt { 169 1.3.2.2 yamt if (edata->units != ENVSYS_STEMP) 170 1.3.2.2 yamt return false; 171 1.3.2.2 yamt return strcmp(edata->desc, "external") == 0; 172 1.3.2.2 yamt } 173 1.3.2.2 yamt 174 1.3.2.2 yamt static bool 175 1.3.2.2 yamt is_system_sensor(const envsys_data_t *edata) 176 1.3.2.2 yamt { 177 1.3.2.2 yamt if (edata->units != ENVSYS_STEMP) 178 1.3.2.2 yamt return false; 179 1.3.2.2 yamt return strcmp(edata->desc, "internal") == 0; 180 1.3.2.2 yamt } 181 1.3.2.2 yamt 182 1.3.2.2 yamt static void 183 1.3.2.2 yamt tda_adjust(void *v) 184 1.3.2.2 yamt { 185 1.3.2.2 yamt struct tda_softc *sc = v; 186 1.3.2.2 yamt u_int64_t ctemp, stemp; 187 1.3.2.2 yamt u_int16_t cspeed, sspeed; 188 1.3.2.2 yamt 189 1.3.2.2 yamt /* Default to running the fans at maximum speed. */ 190 1.3.2.2 yamt sspeed = cspeed = TDA_FANSPEED_MAX; 191 1.3.2.2 yamt 192 1.3.2.2 yamt /* fetch maximum current temperature */ 193 1.3.2.2 yamt ctemp = sysmon_envsys_get_max_value(is_cpu_sensor, true); 194 1.3.2.2 yamt stemp = sysmon_envsys_get_max_value(is_system_sensor, true); 195 1.3.2.2 yamt 196 1.3.2.2 yamt /* the predicates for selecting sensors must have gone wrong */ 197 1.3.2.2 yamt if (ctemp == 0 || stemp == 0) { 198 1.3.2.2 yamt aprint_error_dev(sc->sc_dev, "skipping temp adjustment" 199 1.3.2.2 yamt " - no sensor values\n"); 200 1.3.2.2 yamt return; 201 1.3.2.2 yamt } 202 1.3.2.2 yamt 203 1.3.2.2 yamt aprint_debug_dev(sc->sc_dev, "current temperature: cpu %" PRIu64 204 1.3.2.2 yamt " system %" PRIu64 "\n", 205 1.3.2.2 yamt ctemp, stemp); 206 1.3.2.2 yamt 207 1.3.2.2 yamt if (ctemp < CPU_TEMP_MIN) 208 1.3.2.2 yamt cspeed = TDA_FANSPEED_MIN; 209 1.3.2.2 yamt else if (ctemp < CPU_TEMP_MAX) 210 1.3.2.2 yamt cspeed = TDA_FANSPEED_MIN + 211 1.3.2.2 yamt (ctemp - CPU_TEMP_MIN) * 212 1.3.2.2 yamt (TDA_FANSPEED_MAX - TDA_FANSPEED_MIN) / 213 1.3.2.2 yamt (CPU_TEMP_MAX - CPU_TEMP_MIN); 214 1.3.2.2 yamt 215 1.3.2.2 yamt if (stemp < SYS_TEMP_MIN) 216 1.3.2.2 yamt sspeed = TDA_FANSPEED_MIN; 217 1.3.2.2 yamt else if (stemp < SYS_TEMP_MAX) 218 1.3.2.2 yamt sc->sc_sfan_speed = TDA_FANSPEED_MIN + 219 1.3.2.2 yamt (stemp - SYS_TEMP_MIN) * 220 1.3.2.2 yamt (TDA_FANSPEED_MAX - TDA_FANSPEED_MIN) / 221 1.3.2.2 yamt (SYS_TEMP_MAX - SYS_TEMP_MIN); 222 1.3.2.2 yamt 223 1.3.2.2 yamt if (sspeed == sc->sc_sfan_speed && cspeed == sc->sc_cfan_speed) 224 1.3.2.2 yamt return; 225 1.3.2.2 yamt 226 1.3.2.2 yamt sc->sc_sfan_speed = sspeed; 227 1.3.2.2 yamt sc->sc_cfan_speed = cspeed; 228 1.3.2.2 yamt tda_setspeed(sc); 229 1.3.2.2 yamt } 230
Indexes created Thu Oct 02 14:10:14 GMT 2025