amdzentemp.c revision 1.3
1 /* $NetBSD: amdzentemp.c,v 1.3 2018/01/25 21:23:36 pgoyette Exp $ */ 2 /* $OpenBSD: kate.c,v 1.2 2008/03/27 04:52:03 cnst Exp $ */ 3 4 /* 5 * Copyright (c) 2008 The NetBSD Foundation, Inc. 6 * All rights reserved. 7 * 8 * This code is derived from software contributed to The NetBSD Foundation 9 * by Christoph Egger. 10 * 11 * NetBSD port by Ian Clark <mrrooster (at) gmail.com> 12 * 13 * Redistribution and use in source and binary forms, with or without 14 * modification, are permitted provided that the following conditions 15 * are met: 16 * 1. Redistributions of source code must retain the above copyright 17 * notice, this list of conditions and the following disclaimer. 18 * 2. Redistributions in binary form must reproduce the above copyright 19 * notice, this list of conditions and the following disclaimer in the 20 * documentation and/or other materials provided with the distribution. 21 * 22 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 23 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 24 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 25 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 26 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 27 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 28 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 29 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 30 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 31 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 32 * POSSIBILITY OF SUCH DAMAGE. 33 */ 34 35 /* 36 * Copyright (c) 2008 Constantine A. Murenin <cnst+openbsd (at) bugmail.mojo.ru> 37 * 38 * Permission to use, copy, modify, and distribute this software for any 39 * purpose with or without fee is hereby granted, provided that the above 40 * copyright notice and this permission notice appear in all copies. 41 * 42 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 43 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 44 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 45 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 46 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 47 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 48 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 49 */ 50 51 52 #include <sys/cdefs.h> 53 __KERNEL_RCSID(0, "$NetBSD: amdzentemp.c,v 1.3 2018/01/25 21:23:36 pgoyette Exp $ "); 54 55 #include <sys/param.h> 56 #include <sys/bus.h> 57 #include <sys/cpu.h> 58 #include <sys/systm.h> 59 #include <sys/device.h> 60 #include <sys/kmem.h> 61 #include <sys/module.h> 62 63 #include <machine/specialreg.h> 64 65 #include <dev/pci/pcireg.h> 66 #include <dev/pci/pcivar.h> 67 #include <dev/pci/pcidevs.h> 68 69 #include <dev/sysmon/sysmonvar.h> 70 71 #include "amdsmn.h" 72 73 /* Address to query for temp on family 17h */ 74 #define AMD_17H_CUR_TMP 0x59800 75 76 struct amdzentemp_softc { 77 pci_chipset_tag_t sc_pc; 78 pcitag_t sc_pcitag; 79 struct sysmon_envsys *sc_sme; 80 device_t sc_smn; 81 envsys_data_t *sc_sensor; 82 size_t sc_sensor_len; 83 size_t sc_numsensors; 84 }; 85 86 87 static int amdzentemp_match(device_t, cfdata_t, void *); 88 static void amdzentemp_attach(device_t, device_t, void *); 89 static int amdzentemp_detach(device_t, int); 90 91 static void amdzentemp_family17_init(struct amdzentemp_softc *); 92 static void amdzentemp_family17_setup_sensors(struct amdzentemp_softc *, int); 93 static void amdzentemp_family17_refresh(struct sysmon_envsys *, envsys_data_t *); 94 95 CFATTACH_DECL_NEW(amdzentemp, sizeof(struct amdzentemp_softc), 96 amdzentemp_match, amdzentemp_attach, amdzentemp_detach, NULL); 97 98 static int 99 amdzentemp_match(device_t parent, cfdata_t match, void *aux) 100 { 101 102 KASSERT(PCI_VENDOR(pa->pa_id) == PCI_VENDOR_AMD); 103 104 cfdata_t parent_cfdata = device_cfdata(parent); 105 106 /* Got AMD family 17h system management network */ 107 return parent_cfdata->cf_name && 108 memcmp(parent_cfdata->cf_name, "amdsmn", 6) == 0; 109 } 110 111 static void 112 amdzentemp_attach(device_t parent, device_t self, void *aux) 113 { 114 struct amdzentemp_softc *sc = device_private(self); 115 struct pci_attach_args *pa = aux; 116 int error; 117 size_t i; 118 119 aprint_naive("\n"); 120 aprint_normal(": AMD CPU Temperature Sensors (Family17h)"); 121 122 sc->sc_pc = pa->pa_pc; 123 sc->sc_pcitag = pa->pa_tag; 124 sc->sc_smn = parent; 125 126 amdzentemp_family17_init(sc); 127 128 aprint_normal("\n"); 129 130 sc->sc_sme = sysmon_envsys_create(); 131 sc->sc_sensor_len = sizeof(envsys_data_t) * sc->sc_numsensors; 132 sc->sc_sensor = kmem_zalloc(sc->sc_sensor_len, KM_SLEEP); 133 134 amdzentemp_family17_setup_sensors(sc, device_unit(self)); 135 136 /* 137 * Set properties in sensors. 138 */ 139 for (i = 0; i < sc->sc_numsensors; i++) { 140 if (sysmon_envsys_sensor_attach(sc->sc_sme, &sc->sc_sensor[i])) 141 goto bad; 142 } 143 144 /* 145 * Register the sysmon_envsys device. 146 */ 147 sc->sc_sme->sme_name = device_xname(self); 148 sc->sc_sme->sme_cookie = sc; 149 150 sc->sc_sme->sme_refresh = amdzentemp_family17_refresh; 151 152 error = sysmon_envsys_register(sc->sc_sme); 153 if (error) { 154 aprint_error_dev(self, "unable to register with sysmon " 155 "(error=%d)\n", error); 156 goto bad; 157 } 158 159 (void)pmf_device_register(self, NULL, NULL); 160 161 return; 162 163 bad: 164 if (sc->sc_sme != NULL) { 165 sysmon_envsys_destroy(sc->sc_sme); 166 sc->sc_sme = NULL; 167 } 168 169 if (sc->sc_sensor != NULL) { 170 kmem_free(sc->sc_sensor, sc->sc_sensor_len); 171 sc->sc_sensor = NULL; 172 } 173 } 174 175 static int 176 amdzentemp_detach(device_t self, int flags) 177 { 178 struct amdzentemp_softc *sc = device_private(self); 179 180 pmf_device_deregister(self); 181 if (sc->sc_sme != NULL) 182 sysmon_envsys_unregister(sc->sc_sme); 183 184 if (sc->sc_sensor != NULL) 185 kmem_free(sc->sc_sensor, sc->sc_sensor_len); 186 187 return 0; 188 } 189 190 191 static void 192 amdzentemp_family17_init(struct amdzentemp_softc *sc) 193 { 194 sc->sc_numsensors = 1; 195 } 196 197 static void 198 amdzentemp_family17_setup_sensors(struct amdzentemp_softc *sc, int dv_unit) 199 { 200 sc->sc_sensor[0].units = ENVSYS_STEMP; 201 sc->sc_sensor[0].state = ENVSYS_SVALID; 202 sc->sc_sensor[0].flags = ENVSYS_FHAS_ENTROPY; 203 204 snprintf(sc->sc_sensor[0].desc, sizeof(sc->sc_sensor[0].desc), 205 "cpu%u temperature", dv_unit); 206 } 207 208 static void 209 amdzentemp_family17_refresh(struct sysmon_envsys *sme, envsys_data_t *edata) 210 { 211 struct amdzentemp_softc *sc = sme->sme_cookie; 212 uint32_t temp; 213 int error; 214 215 error = amdsmn_read(sc->sc_smn, AMD_17H_CUR_TMP, &temp); 216 if (error) { 217 edata->state = ENVSYS_SINVALID; 218 return; 219 } 220 edata->state = ENVSYS_SVALID; 221 /* From C to uK. */ 222 edata->value_cur = ((temp >> 21) * 125000) + 273150000; 223 } 224 225 MODULE(MODULE_CLASS_DRIVER, amdzentemp, "sysmon_envsys"); 226 227 #ifdef _MODULE 228 #include "ioconf.c" 229 #endif 230 231 static int 232 amdzentemp_modcmd(modcmd_t cmd, void *aux) 233 { 234 int error = 0; 235 236 switch (cmd) { 237 case MODULE_CMD_INIT: 238 #ifdef _MODULE 239 error = config_init_component(cfdriver_ioconf_amdzentemp, 240 cfattach_ioconf_amdzentemp, cfdata_ioconf_amdzentemp); 241 #endif 242 return error; 243 case MODULE_CMD_FINI: 244 #ifdef _MODULE 245 error = config_fini_component(cfdriver_ioconf_amdzentemp, 246 cfattach_ioconf_amdzentemp, cfdata_ioconf_amdzentemp); 247 #endif 248 return error; 249 default: 250 return ENOTTY; 251 } 252 } 253 254
Indexes created Tue Sep 30 07:10:03 GMT 2025