tda.c revision 1.11.16.1
1 /* $NetBSD: tda.c,v 1.11.16.1 2018/06/25 07:25:45 pgoyette Exp $ */ 2 /* $OpenBSD: tda.c,v 1.4 2008/02/27 17:25:00 robert Exp $ */ 3 4 /* 5 * Copyright (c) 2008 Robert Nagy <robert (at) openbsd.org> 6 * Copyright (c) 2008 Mark Kettenis <kettenis (at) openbsd.org> 7 * 8 * Permission to use, copy, modify, and distribute this software for any 9 * purpose with or without fee is hereby granted, provided that the above 10 * copyright notice and this permission notice appear in all copies. 11 * 12 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 13 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 14 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 15 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 16 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 17 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 18 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 19 */ 20 21 #include <sys/cdefs.h> 22 __KERNEL_RCSID(0, "$NetBSD: tda.c,v 1.11.16.1 2018/06/25 07:25:45 pgoyette Exp $"); 23 24 #include <sys/param.h> 25 #include <sys/systm.h> 26 #include <sys/kernel.h> 27 #include <sys/device.h> 28 #include <dev/sysmon/sysmonvar.h> 29 #include <dev/sysmon/sysmon_taskq.h> 30 31 #include <machine/autoconf.h> 32 #include <machine/openfirm.h> 33 34 #include <dev/i2c/i2cvar.h> 35 36 /* fan control registers */ 37 #define TDA_SYSFAN_REG 0xf0 38 #define TDA_CPUFAN_REG 0xf2 39 #define TDA_PSFAN_REG 0xf4 40 41 #define TDA_FANSPEED_MIN 0x0c 42 #define TDA_FANSPEED_MAX 0x3f 43 44 #define TDA_PSFAN_ON 0x1f 45 #define TDA_PSFAN_OFF 0x00 46 47 /* Internal and External temperature sensor numbers */ 48 #define SENSOR_TEMP_EXT 0 49 #define SENSOR_TEMP_INT 1 50 51 /* Fan sensor numbers */ 52 #define SENSOR_FAN_CPU 0 53 #define SENSOR_FAN_SYS 1 54 55 #define CPU_TEMP_MAX (67 * 1000000 + 273150000) 56 #define CPU_TEMP_MIN (57 * 1000000 + 273150000) 57 #define SYS_TEMP_MAX (30 * 1000000 + 273150000) 58 #define SYS_TEMP_MIN (20 * 1000000 + 273150000) 59 60 struct tda_softc { 61 device_t sc_dev; 62 i2c_tag_t sc_tag; 63 i2c_addr_t sc_addr; 64 65 u_int16_t sc_cfan_speed; /* current CPU fan speed */ 66 u_int16_t sc_sfan_speed; /* current SYS fan speed */ 67 68 struct sysmon_envsys *sc_sme; 69 envsys_data_t sc_sensor[2]; 70 71 callout_t sc_timer; 72 }; 73 74 int tda_match(device_t, cfdata_t, void *); 75 void tda_attach(device_t, device_t, void *); 76 static int tda_detach(device_t, int); 77 void tda_refresh(struct sysmon_envsys *, envsys_data_t *); 78 79 void tda_setspeed(struct tda_softc *); 80 static void tda_adjust(void *); 81 static void tda_timeout(void *); 82 83 84 CFATTACH_DECL3_NEW(tda, sizeof(struct tda_softc), 85 tda_match, tda_attach, tda_detach, NULL, NULL, NULL, 86 DVF_DETACH_SHUTDOWN); 87 88 int 89 tda_match(device_t parent, cfdata_t match, void *aux) 90 { 91 struct i2c_attach_args *ia = aux; 92 93 /* Only attach on the Sun Blade 1000/2000. */ 94 if (strcmp(machine_model, "SUNW,Sun-Blade-1000") != 0) 95 return (0); 96 97 /* 98 * No need for "compatible" matching, we know exactly what 99 * firmware calls us. 100 */ 101 if (ia->ia_name == NULL) 102 return(0); 103 104 return strcmp(ia->ia_name, "fan-control") == 0 ? 105 I2C_MATCH_DIRECT_SPECIFIC : 0; 106 } 107 108 void 109 tda_attach(device_t parent, device_t self, void *aux) 110 { 111 struct tda_softc *sc = device_private(self); 112 struct i2c_attach_args *ia = aux; 113 int rc; 114 115 sc->sc_dev = self; 116 sc->sc_tag = ia->ia_tag; 117 sc->sc_addr = ia->ia_addr; 118 119 aprint_normal(": %s\n", ia->ia_name); 120 aprint_naive(": Environment sensor\n"); 121 122 /* 123 * Set the fans to maximum speed and save the power levels; 124 * the controller is write-only. 125 */ 126 sc->sc_cfan_speed = sc->sc_sfan_speed = (TDA_FANSPEED_MAX+TDA_FANSPEED_MIN)/2; 127 tda_setspeed(sc); 128 129 callout_init(&sc->sc_timer, CALLOUT_MPSAFE); 130 callout_reset(&sc->sc_timer, hz*20, tda_timeout, sc); 131 132 /* Initialise sensor data */ 133 sc->sc_sensor[SENSOR_FAN_CPU].state = ENVSYS_SINVALID; 134 sc->sc_sensor[SENSOR_FAN_CPU].units = ENVSYS_INTEGER; 135 sc->sc_sensor[SENSOR_FAN_CPU].flags = ENVSYS_FMONNOTSUPP; 136 strlcpy(sc->sc_sensor[SENSOR_FAN_CPU].desc, 137 "fan.cpu",sizeof("fan.cpu")); 138 sc->sc_sensor[SENSOR_FAN_SYS].state = ENVSYS_SINVALID; 139 sc->sc_sensor[SENSOR_FAN_SYS].units = ENVSYS_INTEGER; 140 sc->sc_sensor[SENSOR_FAN_SYS].flags = ENVSYS_FMONNOTSUPP; 141 strlcpy(sc->sc_sensor[SENSOR_FAN_SYS].desc, 142 "fan.sys",sizeof("fan.sys")); 143 sc->sc_sme = sysmon_envsys_create(); 144 rc = sysmon_envsys_sensor_attach( 145 sc->sc_sme, &sc->sc_sensor[SENSOR_FAN_CPU]); 146 if (rc) { 147 sysmon_envsys_destroy(sc->sc_sme); 148 aprint_error_dev(self, 149 "unable to attach cpu fan at sysmon, error %d\n", rc); 150 return; 151 } 152 rc = sysmon_envsys_sensor_attach( 153 sc->sc_sme, &sc->sc_sensor[SENSOR_FAN_SYS]); 154 if (rc) { 155 sysmon_envsys_destroy(sc->sc_sme); 156 aprint_error_dev(self, 157 "unable to attach sys fan at sysmon, error %d\n", rc); 158 return; 159 } 160 sc->sc_sme->sme_name = device_xname(self); 161 sc->sc_sme->sme_cookie = sc; 162 sc->sc_sme->sme_refresh = tda_refresh; 163 rc = sysmon_envsys_register(sc->sc_sme); 164 if (rc) { 165 aprint_error_dev(self, 166 "unable to register with sysmon, error %d\n", rc); 167 sysmon_envsys_destroy(sc->sc_sme); 168 return; 169 } 170 } 171 172 int 173 tda_detach(device_t self, int flags) 174 { 175 struct tda_softc *sc = device_private(self); 176 177 if (sc->sc_sme != NULL) 178 sysmon_envsys_destroy(sc->sc_sme); 179 180 callout_halt(&sc->sc_timer, NULL); 181 callout_destroy(&sc->sc_timer); 182 183 sc->sc_cfan_speed = sc->sc_sfan_speed = TDA_FANSPEED_MAX; 184 tda_setspeed(sc); 185 return 0; 186 } 187 188 static void 189 tda_timeout(void *v) 190 { 191 struct tda_softc *sc = v; 192 193 sysmon_task_queue_sched(0, tda_adjust, sc); 194 callout_reset(&sc->sc_timer, hz*60, tda_timeout, sc); 195 } 196 197 void 198 tda_setspeed(struct tda_softc *sc) 199 { 200 u_int8_t cmd[2]; 201 202 if (sc->sc_cfan_speed < TDA_FANSPEED_MIN) 203 sc->sc_cfan_speed = TDA_FANSPEED_MIN; 204 if (sc->sc_sfan_speed < TDA_FANSPEED_MIN) 205 sc->sc_sfan_speed = TDA_FANSPEED_MIN; 206 if (sc->sc_cfan_speed > TDA_FANSPEED_MAX) 207 sc->sc_cfan_speed = TDA_FANSPEED_MAX; 208 if (sc->sc_sfan_speed > TDA_FANSPEED_MAX) 209 sc->sc_sfan_speed = TDA_FANSPEED_MAX; 210 211 iic_acquire_bus(sc->sc_tag, 0); 212 213 cmd[0] = TDA_CPUFAN_REG; 214 cmd[1] = sc->sc_cfan_speed; 215 if (iic_exec(sc->sc_tag, I2C_OP_WRITE_WITH_STOP, 216 sc->sc_addr, &cmd, sizeof(cmd), NULL, 0, 0)) { 217 aprint_error_dev(sc->sc_dev, "cannot write cpu-fan register\n"); 218 iic_release_bus(sc->sc_tag, 0); 219 return; 220 } 221 222 cmd[0] = TDA_SYSFAN_REG; 223 cmd[1] = sc->sc_sfan_speed; 224 if (iic_exec(sc->sc_tag, I2C_OP_WRITE_WITH_STOP, 225 sc->sc_addr, &cmd, sizeof(cmd), NULL, 0, 0)) { 226 aprint_error_dev(sc->sc_dev, "cannot write system-fan register\n"); 227 iic_release_bus(sc->sc_tag, 0); 228 return; 229 } 230 231 iic_release_bus(sc->sc_tag, 0); 232 233 aprint_debug_dev(sc->sc_dev, "changed fan speed to cpu=%d system=%d\n", 234 sc->sc_cfan_speed, sc->sc_sfan_speed); 235 } 236 237 static bool 238 is_cpu_sensor(const envsys_data_t *edata) 239 { 240 if (edata->units != ENVSYS_STEMP) 241 return false; 242 return strcmp(edata->desc, "external") == 0; 243 } 244 245 static bool 246 is_system_sensor(const envsys_data_t *edata) 247 { 248 if (edata->units != ENVSYS_STEMP) 249 return false; 250 return strcmp(edata->desc, "internal") == 0; 251 } 252 253 static void 254 tda_adjust(void *v) 255 { 256 struct tda_softc *sc = v; 257 u_int64_t ctemp, stemp; 258 u_int16_t cspeed, sspeed; 259 260 /* Default to running the fans at maximum speed. */ 261 sspeed = cspeed = TDA_FANSPEED_MAX; 262 263 /* fetch maximum current temperature */ 264 ctemp = sysmon_envsys_get_max_value(is_cpu_sensor, true); 265 stemp = sysmon_envsys_get_max_value(is_system_sensor, true); 266 267 /* the predicates for selecting sensors must have gone wrong */ 268 if (ctemp == 0 || stemp == 0) { 269 aprint_error_dev(sc->sc_dev, "skipping temp adjustment" 270 " - no sensor values\n"); 271 return; 272 } 273 274 aprint_debug_dev(sc->sc_dev, "current temperature: cpu %" PRIu64 275 " system %" PRIu64 "\n", 276 ctemp, stemp); 277 278 if (ctemp < CPU_TEMP_MIN) 279 cspeed = TDA_FANSPEED_MIN; 280 else if (ctemp < CPU_TEMP_MAX) 281 cspeed = TDA_FANSPEED_MIN + 282 (ctemp - CPU_TEMP_MIN) * 283 (TDA_FANSPEED_MAX - TDA_FANSPEED_MIN) / 284 (CPU_TEMP_MAX - CPU_TEMP_MIN); 285 286 if (stemp < SYS_TEMP_MIN) 287 sspeed = TDA_FANSPEED_MIN; 288 else if (stemp < SYS_TEMP_MAX) 289 sspeed = TDA_FANSPEED_MIN + 290 (stemp - SYS_TEMP_MIN) * 291 (TDA_FANSPEED_MAX - TDA_FANSPEED_MIN) / 292 (SYS_TEMP_MAX - SYS_TEMP_MIN); 293 294 if (sspeed == sc->sc_sfan_speed && cspeed == sc->sc_cfan_speed) 295 return; 296 297 sc->sc_sfan_speed = sspeed; 298 sc->sc_cfan_speed = cspeed; 299 tda_setspeed(sc); 300 } 301 302 void 303 tda_refresh(struct sysmon_envsys *sme, envsys_data_t *edata) 304 { 305 struct tda_softc *sc = sme->sme_cookie; 306 u_int16_t speed; 307 308 if (edata->sensor == SENSOR_FAN_CPU) 309 speed = sc->sc_cfan_speed; 310 else 311 speed = sc->sc_sfan_speed; 312 if (!speed) 313 edata->state = ENVSYS_SINVALID; 314 else { 315 edata->value_cur = speed; 316 edata->state = ENVSYS_SVALID; 317 } 318 } 319 320
Indexes created Thu Oct 02 14:10:14 GMT 2025