sys/dev/powermng/km/km.c

   1 /*      $OpenBSD: km.c,v 1.2 2008/08/29 03:38:31 cnst Exp $     */
   2
   3 /*
   4  * Copyright (c) 2008/2010 Constantine A. Murenin <cnst+dfly@bugmail.mojo.ru>
   5  *
   6  * Permission to use, copy, modify, and distribute this software for any
   7  * purpose with or without fee is hereby granted, provided that the above
   8  * copyright notice and this permission notice appear in all copies.
   9  *
  10  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
  11  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  12  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
  13  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  14  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  15  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  16  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  17  */
  18
  19 #include <sys/param.h>
  20 #include <sys/systm.h>
  21 #include <sys/bus.h>
  22 #include <sys/sensors.h>
  23
  24 #include <bus/pci/pcivar.h>
  25 #include <bus/pci/pcidevs.h>
  26
  27
  28 /*
  29  * AMD Family 10h Processors, Function 3 -- Miscellaneous Control
  30  */
  31
  32 /* Function 3 Registers */
  33 #define KM_REP_TEMP_CONTR_R     0xa4
  34 #define KM_THERMTRIP_STAT_R     0xe4
  35 #define KM_NORTHBRIDGE_CAP_R    0xe8
  36 #define KM_CPUID_FAMILY_MODEL_R 0xfc
  37
  38 /* Operations on Reported Temperature Control Register */
  39 #define KM_GET_CURTMP(r)        (((r) >> 21) & 0x7ff)
  40
  41 /* Operations on Thermtrip Status Register */
  42 #define KM_GET_DIODEOFFSET(r)   (((r) >> 8) & 0x7f)
  43
  44
  45 struct km_softc {
  46         struct device           *sc_dev;
  47         struct ksensor          sc_sensor;
  48         struct ksensordev       sc_sensordev;
  49 };
  50
  51 static void     km_identify(driver_t *, struct device *);
  52 static int      km_probe(struct device *);
  53 static int      km_attach(struct device *);
  54 static int      km_detach(struct device *);
  55 static void     km_refresh(void *);
  56
  57 static device_method_t km_methods[] = {
  58         DEVMETHOD(device_identify,      km_identify),
  59         DEVMETHOD(device_probe,         km_probe),
  60         DEVMETHOD(device_attach,        km_attach),
  61         DEVMETHOD(device_detach,        km_detach),
  62         { NULL, NULL }
  63 };
  64
  65 static driver_t km_driver = {
  66         "km",
  67         km_methods,
  68         sizeof(struct km_softc)
  69 };
  70
  71 static devclass_t km_devclass;
  72
  73 DRIVER_MODULE(km, hostb, km_driver, km_devclass, NULL, NULL);
  74
  75
  76 static void
  77 km_identify(driver_t *driver, struct device *parent)
  78 {
  79         if (km_probe(parent) == ENXIO)
  80                 return;
  81         if (device_find_child(parent, driver->name, -1) != NULL)
  82                 return;
  83         device_add_child(parent, driver->name, -1);
  84 }
  85
  86 static int
  87 km_probe(struct device *dev)
  88 {
  89         int ten = 0;
  90
  91         if (pci_get_vendor(dev) != PCI_VENDOR_AMD)
  92                 return ENXIO;
  93
  94         switch (pci_get_device(dev)) {
  95         case PCI_PRODUCT_AMD_AMD64_F10_MISC:
  96                 ten = 1;
  97                 /* FALLTHROUGH */
  98         case PCI_PRODUCT_AMD_AMD64_F11_MISC:
  99                 if (device_get_desc(dev) == NULL)
 100                         device_set_desc(dev, ten ?
 101                             "AMD Family 10h temperature sensor" :
 102                             "AMD Family 11h temperature sensor");
 103                 return 0;
 104         default:
 105                 return ENXIO;
 106         }
 107 }
 108
 109 static int
 110 km_attach(struct device *dev)
 111 {
 112         struct km_softc *sc;
 113
 114         sc = device_get_softc(dev);
 115         sc->sc_dev = dev;
 116
 117         strlcpy(sc->sc_sensordev.xname, device_get_nameunit(dev),
 118             sizeof(sc->sc_sensordev.xname));
 119
 120         sc->sc_sensor.type = SENSOR_TEMP;
 121         sensor_attach(&sc->sc_sensordev, &sc->sc_sensor);
 122
 123         if (sensor_task_register(sc, km_refresh, 5)) {
 124                 device_printf(dev, "unable to register update task\n");
 125                 return ENXIO;
 126         }
 127
 128         sensordev_install(&sc->sc_sensordev);
 129         return 0;
 130 }
 131
 132 static int
 133 km_detach(struct device *dev)
 134 {
 135         struct km_softc *sc = device_get_softc(dev);
 136
 137         sensordev_deinstall(&sc->sc_sensordev);
 138         sensor_task_unregister(sc);
 139         return 0;
 140 }
 141
 142 static void
 143 km_refresh(void *arg)
 144 {
 145         struct km_softc *sc = arg;
 146         struct ksensor  *s = &sc->sc_sensor;
 147         uint32_t        r;
 148         int             c;
 149
 150         r = pci_read_config(sc->sc_dev, KM_REP_TEMP_CONTR_R, 4);
 151         c = KM_GET_CURTMP(r);
 152         s->value = c * 125000 + 273150000;
 153 }