sys/dev/powermng/it/it.c

   1 /*
   2  * Copyright (c) 2003 Julien Bordet <zejames@greyhats.org>
   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 ``AS IS'' AND ANY EXPRESS OR
  15  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  16  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  17  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  18  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  19  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  20  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  21  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  22  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  23  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  24  *
  25  * $OpenBSD: it.c,v 1.22 2007/03/22 16:55:31 deraadt Exp $
  26  */
  27
  28 #include <sys/param.h>
  29 #include <sys/kernel.h>
  30 #include <sys/bus.h>
  31 #include <sys/module.h>
  32 #include <sys/rman.h>
  33
  34 #include <bus/isa/isavar.h>
  35 #include <sys/systm.h>
  36
  37 #include <sys/sensors.h>
  38
  39 #include "itvar.h"
  40
  41 #if defined(ITDEBUG)
  42 #define DPRINTF(x)              do { kprintf x; } while (0)
  43 #else
  44 #define DPRINTF(x)
  45 #endif
  46
  47 /*
  48  * IT87-compatible chips can typically measure voltages up to 4.096 V.
  49  * To measure higher voltages the input is attenuated with (external)
  50  * resistors.  Negative voltages are measured using a reference
  51  * voltage.  So we have to convert the sensor values back to real
  52  * voltages by applying the appropriate resistor factor.
  53  */
  54 #define RFACT_NONE      10000
  55 #define RFACT(x, y)     (RFACT_NONE * ((x) + (y)) / (y))
  56
  57 int it_probe(struct device *);
  58 int it_attach(struct device *);
  59 int it_detach(struct device *);
  60 u_int8_t it_readreg(struct it_softc *, int);
  61 void it_writereg(struct it_softc *, int, int);
  62 void it_setup_volt(struct it_softc *, int, int);
  63 void it_setup_temp(struct it_softc *, int, int);
  64 void it_setup_fan(struct it_softc *, int, int);
  65
  66 void it_generic_stemp(struct it_softc *, struct ksensor *);
  67 void it_generic_svolt(struct it_softc *, struct ksensor *);
  68 void it_generic_fanrpm(struct it_softc *, struct ksensor *);
  69
  70 void it_refresh_sensor_data(struct it_softc *);
  71 void it_refresh(void *);
  72
  73 static device_method_t it_methods[] = {
  74         /* Methods from the device interface */
  75         DEVMETHOD(device_probe,         it_probe),
  76         DEVMETHOD(device_attach,        it_attach),
  77         DEVMETHOD(device_detach,        it_detach),
  78
  79         /* Terminate method list */
  80         { 0, 0 }
  81 };
  82
  83 static driver_t it_driver = {
  84         "it",
  85         it_methods,
  86         sizeof (struct it_softc)
  87 };
  88
  89 static devclass_t it_devclass;
  90
  91 DRIVER_MODULE(it, isa, it_driver, it_devclass, NULL, NULL);
  92
  93
  94 const int it_vrfact[] = {
  95         RFACT_NONE,
  96         RFACT_NONE,
  97         RFACT_NONE,
  98         RFACT(68, 100),
  99         RFACT(30, 10),
 100         RFACT(21, 10),
 101         RFACT(83, 20),
 102         RFACT(68, 100),
 103         RFACT_NONE
 104 };
 105
 106 int
 107 it_probe(struct device *dev)
 108 {
 109         struct resource *iores;
 110         int iorid = 0;
 111         bus_space_tag_t iot;
 112         bus_space_handle_t ioh;
 113         u_int8_t cr;
 114
 115         iores = bus_alloc_resource(dev, SYS_RES_IOPORT, &iorid,
 116             0ul, ~0ul, 8, RF_ACTIVE);
 117         if (iores == NULL) {
 118                 DPRINTF(("%s: can't map i/o space\n", __func__));
 119                 return 1;
 120         }
 121         iot = rman_get_bustag(iores);
 122         ioh = rman_get_bushandle(iores);
 123
 124         /* Check Vendor ID */
 125         bus_space_write_1(iot, ioh, ITC_ADDR, ITD_CHIPID);
 126         cr = bus_space_read_1(iot, ioh, ITC_DATA);
 127         bus_release_resource(dev, SYS_RES_IOPORT, iorid, iores);
 128         DPRINTF(("it: vendor id 0x%x\n", cr));
 129         if (cr != IT_ID_IT87)
 130                 return 1;
 131
 132         return 0;
 133 }
 134
 135 int
 136 it_attach(struct device *dev)
 137 {
 138         struct it_softc *sc = device_get_softc(dev);
 139         int i;
 140         u_int8_t cr;
 141
 142         sc->sc_dev = dev;
 143         sc->sc_iores = bus_alloc_resource(dev, SYS_RES_IOPORT, &sc->sc_iorid,
 144             0ul, ~0ul, 8, RF_ACTIVE);
 145         if (sc->sc_iores == NULL) {
 146                 device_printf(dev, "can't map i/o space\n");
 147                 return 1;
 148         }
 149         sc->sc_iot = rman_get_bustag(sc->sc_iores);
 150         sc->sc_ioh = rman_get_bushandle(sc->sc_iores);
 151
 152         sc->numsensors = IT_NUM_SENSORS;
 153
 154         it_setup_fan(sc, 0, 3);
 155         it_setup_volt(sc, 3, 9);
 156         it_setup_temp(sc, 12, 3);
 157
 158         if (sensor_task_register(sc, it_refresh, 5)) {
 159                 device_printf(sc->sc_dev, "unable to register update task\n");
 160                 return 1;
 161         }
 162
 163         /* Activate monitoring */
 164         cr = it_readreg(sc, ITD_CONFIG);
 165         cr |= 0x01 | 0x08;
 166         it_writereg(sc, ITD_CONFIG, cr);
 167
 168         /* Initialize sensors */
 169         strlcpy(sc->sensordev.xname, device_get_nameunit(sc->sc_dev),
 170             sizeof(sc->sensordev.xname));
 171         for (i = 0; i < sc->numsensors; ++i)
 172                 sensor_attach(&sc->sensordev, &sc->sensors[i]);
 173         sensordev_install(&sc->sensordev);
 174
 175         return 0;
 176 }
 177
 178 int
 179 it_detach(struct device *dev)
 180 {
 181         struct it_softc *sc = device_get_softc(dev);
 182         int error;
 183
 184         sensordev_deinstall(&sc->sensordev);
 185         sensor_task_unregister(sc);
 186
 187         error = bus_release_resource(dev, SYS_RES_IOPORT, sc->sc_iorid,
 188             sc->sc_iores);
 189         if (error)
 190                 return error;
 191
 192         return 0;
 193 }
 194
 195 u_int8_t
 196 it_readreg(struct it_softc *sc, int reg)
 197 {
 198         bus_space_write_1(sc->sc_iot, sc->sc_ioh, ITC_ADDR, reg);
 199         return (bus_space_read_1(sc->sc_iot, sc->sc_ioh, ITC_DATA));
 200 }
 201
 202 void
 203 it_writereg(struct it_softc *sc, int reg, int val)
 204 {
 205         bus_space_write_1(sc->sc_iot, sc->sc_ioh, ITC_ADDR, reg);
 206         bus_space_write_1(sc->sc_iot, sc->sc_ioh, ITC_DATA, val);
 207 }
 208
 209 void
 210 it_setup_volt(struct it_softc *sc, int start, int n)
 211 {
 212         int i;
 213
 214         for (i = 0; i < n; ++i) {
 215                 sc->sensors[start + i].type = SENSOR_VOLTS_DC;
 216         }
 217
 218         ksnprintf(sc->sensors[start + 0].desc, sizeof(sc->sensors[0].desc),
 219             "VCORE_A");
 220         ksnprintf(sc->sensors[start + 1].desc, sizeof(sc->sensors[1].desc),
 221             "VCORE_B");
 222         ksnprintf(sc->sensors[start + 2].desc, sizeof(sc->sensors[2].desc),
 223             "+3.3V");
 224         ksnprintf(sc->sensors[start + 3].desc, sizeof(sc->sensors[3].desc),
 225             "+5V");
 226         ksnprintf(sc->sensors[start + 4].desc, sizeof(sc->sensors[4].desc),
 227             "+12V");
 228         ksnprintf(sc->sensors[start + 5].desc, sizeof(sc->sensors[5].desc),
 229             "Unused");
 230         ksnprintf(sc->sensors[start + 6].desc, sizeof(sc->sensors[6].desc),
 231             "-12V");
 232         ksnprintf(sc->sensors[start + 7].desc, sizeof(sc->sensors[7].desc),
 233             "+5VSB");
 234         ksnprintf(sc->sensors[start + 8].desc, sizeof(sc->sensors[8].desc),
 235             "VBAT");
 236 }
 237
 238 void
 239 it_setup_temp(struct it_softc *sc, int start, int n)
 240 {
 241         int i;
 242
 243         for (i = 0; i < n; ++i)
 244                 sc->sensors[start + i].type = SENSOR_TEMP;
 245 }
 246
 247 void
 248 it_setup_fan(struct it_softc *sc, int start, int n)
 249 {
 250         int i;
 251
 252         for (i = 0; i < n; ++i)
 253                 sc->sensors[start + i].type = SENSOR_FANRPM;
 254 }
 255
 256 void
 257 it_generic_stemp(struct it_softc *sc, struct ksensor *sensors)
 258 {
 259         int i, sdata;
 260
 261         for (i = 0; i < 3; i++) {
 262                 sdata = it_readreg(sc, ITD_SENSORTEMPBASE + i);
 263                 /* Convert temperature to Fahrenheit degres */
 264                 sensors[i].value = sdata * 1000000 + 273150000;
 265         }
 266 }
 267
 268 void
 269 it_generic_svolt(struct it_softc *sc, struct ksensor *sensors)
 270 {
 271         int i, sdata;
 272
 273         for (i = 0; i < 9; i++) {
 274                 sdata = it_readreg(sc, ITD_SENSORVOLTBASE + i);
 275                 DPRINTF(("sdata[volt%d] 0x%x\n", i, sdata));
 276                 /* voltage returned as (mV >> 4) */
 277                 sensors[i].value = (sdata << 4);
 278                 /* these two values are negative and formula is different */
 279                 if (i == 5 || i == 6)
 280                         sensors[i].value = ((sdata << 4) - IT_VREF);
 281                 /* rfact is (factor * 10^4) */
 282                 sensors[i].value *= it_vrfact[i];
 283                 /* division by 10 gets us back to uVDC */
 284                 sensors[i].value /= 10;
 285                 if (i == 5 || i == 6)
 286                         sensors[i].value += IT_VREF * 1000;
 287         }
 288 }
 289
 290 void
 291 it_generic_fanrpm(struct it_softc *sc, struct ksensor *sensors)
 292 {
 293         int i, sdata, divisor, odivisor, ndivisor;
 294
 295         odivisor = ndivisor = divisor = it_readreg(sc, ITD_FAN);
 296         for (i = 0; i < 3; i++, divisor >>= 3) {
 297                 sensors[i].flags &= ~SENSOR_FINVALID;
 298                 if ((sdata = it_readreg(sc, ITD_SENSORFANBASE + i)) == 0xff) {
 299                         sensors[i].flags |= SENSOR_FINVALID;
 300                         if (i == 2)
 301                                 ndivisor ^= 0x40;
 302                         else {
 303                                 ndivisor &= ~(7 << (i * 3));
 304                                 ndivisor |= ((divisor + 1) & 7) << (i * 3);
 305                         }
 306                 } else if (sdata == 0) {
 307                         sensors[i].value = 0;
 308                 } else {
 309                         if (i == 2)
 310                                 divisor = divisor & 1 ? 3 : 1;
 311                         sensors[i].value = 1350000 / (sdata << (divisor & 7));
 312                 }
 313         }
 314         if (ndivisor != odivisor)
 315                 it_writereg(sc, ITD_FAN, ndivisor);
 316 }
 317
 318 /*
 319  * pre:  last read occurred >= 1.5 seconds ago
 320  * post: sensors[] current data are the latest from the chip
 321  */
 322 void
 323 it_refresh_sensor_data(struct it_softc *sc)
 324 {
 325         /* Refresh our stored data for every sensor */
 326         it_generic_stemp(sc, &sc->sensors[12]);
 327         it_generic_svolt(sc, &sc->sensors[3]);
 328         it_generic_fanrpm(sc, &sc->sensors[0]);
 329 }
 330
 331 void
 332 it_refresh(void *arg)
 333 {
 334         struct it_softc *sc = (struct it_softc *)arg;
 335
 336         it_refresh_sensor_data(sc);
 337 }