xref: /freebsd/sys/dev/amdtemp/amdtemp.c (revision 85732ac8)
1 /*-
2  * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
3  *
4  * Copyright (c) 2008, 2009 Rui Paulo <rpaulo@FreeBSD.org>
5  * Copyright (c) 2009 Norikatsu Shigemura <nork@FreeBSD.org>
6  * Copyright (c) 2009-2012 Jung-uk Kim <jkim@FreeBSD.org>
7  * All rights reserved.
8  *
9  * Redistribution and use in source and binary forms, with or without
10  * modification, are permitted provided that the following conditions
11  * are met:
12  * 1. Redistributions of source code must retain the above copyright
13  *    notice, this list of conditions and the following disclaimer.
14  * 2. Redistributions in binary form must reproduce the above copyright
15  *    notice, this list of conditions and the following disclaimer in the
16  *    documentation and/or other materials provided with the distribution.
17  *
18  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
19  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
20  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
21  * DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
22  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
23  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
24  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
25  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
26  * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
27  * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
28  * POSSIBILITY OF SUCH DAMAGE.
29  */
30 
31 /*
32  * Driver for the AMD CPU on-die thermal sensors.
33  * Initially based on the k8temp Linux driver.
34  */
35 
36 #include <sys/cdefs.h>
37 __FBSDID("$FreeBSD$");
38 
39 #include <sys/param.h>
40 #include <sys/bus.h>
41 #include <sys/conf.h>
42 #include <sys/kernel.h>
43 #include <sys/module.h>
44 #include <sys/sysctl.h>
45 #include <sys/systm.h>
46 
47 #include <machine/cpufunc.h>
48 #include <machine/md_var.h>
49 #include <machine/specialreg.h>
50 
51 #include <dev/pci/pcivar.h>
52 #include <x86/pci_cfgreg.h>
53 
54 #include <dev/amdsmn/amdsmn.h>
55 
56 typedef enum {
57 	CORE0_SENSOR0,
58 	CORE0_SENSOR1,
59 	CORE1_SENSOR0,
60 	CORE1_SENSOR1,
61 	CORE0,
62 	CORE1
63 } amdsensor_t;
64 
65 struct amdtemp_softc {
66 	int		sc_ncores;
67 	int		sc_ntemps;
68 	int		sc_flags;
69 #define	AMDTEMP_FLAG_CS_SWAP	0x01	/* ThermSenseCoreSel is inverted. */
70 #define	AMDTEMP_FLAG_CT_10BIT	0x02	/* CurTmp is 10-bit wide. */
71 #define	AMDTEMP_FLAG_ALT_OFFSET	0x04	/* CurTmp starts at -28C. */
72 	int32_t		sc_offset;
73 	int32_t		(*sc_gettemp)(device_t, amdsensor_t);
74 	struct sysctl_oid *sc_sysctl_cpu[MAXCPU];
75 	struct intr_config_hook sc_ich;
76 	device_t	sc_smn;
77 };
78 
79 #define	VENDORID_AMD		0x1022
80 #define	DEVICEID_AMD_MISC0F	0x1103
81 #define	DEVICEID_AMD_MISC10	0x1203
82 #define	DEVICEID_AMD_MISC11	0x1303
83 #define	DEVICEID_AMD_MISC12	0x1403
84 #define	DEVICEID_AMD_MISC14	0x1703
85 #define	DEVICEID_AMD_MISC15	0x1603
86 #define	DEVICEID_AMD_MISC16	0x1533
87 #define	DEVICEID_AMD_MISC16_M30H	0x1583
88 #define	DEVICEID_AMD_MISC17	0x141d
89 #define	DEVICEID_AMD_HOSTB17H_ROOT	0x1450
90 #define	DEVICEID_AMD_HOSTB17H_DF_F3	0x1463
91 #define	DEVICEID_AMD_HOSTB17H_M10H_ROOT	0x15d0
92 #define	DEVICEID_AMD_HOSTB17H_M10H_DF_F3 0x15eb
93 
94 static struct amdtemp_product {
95 	uint16_t	amdtemp_vendorid;
96 	uint16_t	amdtemp_deviceid;
97 } amdtemp_products[] = {
98 	{ VENDORID_AMD,	DEVICEID_AMD_MISC0F },
99 	{ VENDORID_AMD,	DEVICEID_AMD_MISC10 },
100 	{ VENDORID_AMD,	DEVICEID_AMD_MISC11 },
101 	{ VENDORID_AMD,	DEVICEID_AMD_MISC12 },
102 	{ VENDORID_AMD,	DEVICEID_AMD_MISC14 },
103 	{ VENDORID_AMD,	DEVICEID_AMD_MISC15 },
104 	{ VENDORID_AMD,	DEVICEID_AMD_MISC16 },
105 	{ VENDORID_AMD,	DEVICEID_AMD_MISC16_M30H },
106 	{ VENDORID_AMD,	DEVICEID_AMD_MISC17 },
107 	{ VENDORID_AMD,	DEVICEID_AMD_HOSTB17H_ROOT },
108 	{ VENDORID_AMD,	DEVICEID_AMD_HOSTB17H_M10H_ROOT },
109 };
110 
111 /*
112  * Reported Temperature Control Register
113  */
114 #define	AMDTEMP_REPTMP_CTRL	0xa4
115 
116 /*
117  * Reported Temperature, Family 17h
118  *
119  * According to AMD OSRR for 17H, section 4.2.1, bits 31-21 of this register
120  * provide the current temp.  bit 19, when clear, means the temp is reported in
121  * a range 0.."225C" (probable typo for 255C), and when set changes the range
122  * to -49..206C.
123  */
124 #define	AMDTEMP_17H_CUR_TMP		0x59800
125 #define	AMDTEMP_17H_CUR_TMP_RANGE_SEL	(1 << 19)
126 #define	AMDTEMP_17H_CUR_TMP_RANGE_OFF	490
127 
128 /*
129  * Thermaltrip Status Register (Family 0Fh only)
130  */
131 #define	AMDTEMP_THERMTP_STAT	0xe4
132 #define	AMDTEMP_TTSR_SELCORE	0x04
133 #define	AMDTEMP_TTSR_SELSENSOR	0x40
134 
135 /*
136  * DRAM Configuration High Register
137  */
138 #define	AMDTEMP_DRAM_CONF_HIGH	0x94	/* Function 2 */
139 #define	AMDTEMP_DRAM_MODE_DDR3	0x0100
140 
141 /*
142  * CPU Family/Model Register
143  */
144 #define	AMDTEMP_CPUID		0xfc
145 
146 /*
147  * Device methods.
148  */
149 static void 	amdtemp_identify(driver_t *driver, device_t parent);
150 static int	amdtemp_probe(device_t dev);
151 static int	amdtemp_attach(device_t dev);
152 static void	amdtemp_intrhook(void *arg);
153 static int	amdtemp_detach(device_t dev);
154 static int 	amdtemp_match(device_t dev);
155 static int32_t	amdtemp_gettemp0f(device_t dev, amdsensor_t sensor);
156 static int32_t	amdtemp_gettemp(device_t dev, amdsensor_t sensor);
157 static int32_t	amdtemp_gettemp17h(device_t dev, amdsensor_t sensor);
158 static int	amdtemp_sysctl(SYSCTL_HANDLER_ARGS);
159 
160 static device_method_t amdtemp_methods[] = {
161 	/* Device interface */
162 	DEVMETHOD(device_identify,	amdtemp_identify),
163 	DEVMETHOD(device_probe,		amdtemp_probe),
164 	DEVMETHOD(device_attach,	amdtemp_attach),
165 	DEVMETHOD(device_detach,	amdtemp_detach),
166 
167 	DEVMETHOD_END
168 };
169 
170 static driver_t amdtemp_driver = {
171 	"amdtemp",
172 	amdtemp_methods,
173 	sizeof(struct amdtemp_softc),
174 };
175 
176 static devclass_t amdtemp_devclass;
177 DRIVER_MODULE(amdtemp, hostb, amdtemp_driver, amdtemp_devclass, NULL, NULL);
178 MODULE_VERSION(amdtemp, 1);
179 MODULE_DEPEND(amdtemp, amdsmn, 1, 1, 1);
180 MODULE_PNP_INFO("U16:vendor;U16:device", pci, amdtemp, amdtemp_products,
181     nitems(amdtemp_products));
182 
183 static int
184 amdtemp_match(device_t dev)
185 {
186 	int i;
187 	uint16_t vendor, devid;
188 
189 	vendor = pci_get_vendor(dev);
190 	devid = pci_get_device(dev);
191 
192 	for (i = 0; i < nitems(amdtemp_products); i++) {
193 		if (vendor == amdtemp_products[i].amdtemp_vendorid &&
194 		    devid == amdtemp_products[i].amdtemp_deviceid)
195 			return (1);
196 	}
197 
198 	return (0);
199 }
200 
201 static void
202 amdtemp_identify(driver_t *driver, device_t parent)
203 {
204 	device_t child;
205 
206 	/* Make sure we're not being doubly invoked. */
207 	if (device_find_child(parent, "amdtemp", -1) != NULL)
208 		return;
209 
210 	if (amdtemp_match(parent)) {
211 		child = device_add_child(parent, "amdtemp", -1);
212 		if (child == NULL)
213 			device_printf(parent, "add amdtemp child failed\n");
214 	}
215 }
216 
217 static int
218 amdtemp_probe(device_t dev)
219 {
220 	uint32_t family, model;
221 
222 	if (resource_disabled("amdtemp", 0))
223 		return (ENXIO);
224 	if (!amdtemp_match(device_get_parent(dev)))
225 		return (ENXIO);
226 
227 	family = CPUID_TO_FAMILY(cpu_id);
228 	model = CPUID_TO_MODEL(cpu_id);
229 
230 	switch (family) {
231 	case 0x0f:
232 		if ((model == 0x04 && (cpu_id & CPUID_STEPPING) == 0) ||
233 		    (model == 0x05 && (cpu_id & CPUID_STEPPING) <= 1))
234 			return (ENXIO);
235 		break;
236 	case 0x10:
237 	case 0x11:
238 	case 0x12:
239 	case 0x14:
240 	case 0x15:
241 	case 0x16:
242 	case 0x17:
243 		break;
244 	default:
245 		return (ENXIO);
246 	}
247 	device_set_desc(dev, "AMD CPU On-Die Thermal Sensors");
248 
249 	return (BUS_PROBE_GENERIC);
250 }
251 
252 static int
253 amdtemp_attach(device_t dev)
254 {
255 	char tn[32];
256 	u_int regs[4];
257 	struct amdtemp_softc *sc = device_get_softc(dev);
258 	struct sysctl_ctx_list *sysctlctx;
259 	struct sysctl_oid *sysctlnode;
260 	uint32_t cpuid, family, model;
261 	u_int bid;
262 	int erratum319, unit;
263 
264 	erratum319 = 0;
265 
266 	/*
267 	 * CPUID Register is available from Revision F.
268 	 */
269 	cpuid = cpu_id;
270 	family = CPUID_TO_FAMILY(cpuid);
271 	model = CPUID_TO_MODEL(cpuid);
272 	if ((family != 0x0f || model >= 0x40) && family != 0x17) {
273 		cpuid = pci_read_config(dev, AMDTEMP_CPUID, 4);
274 		family = CPUID_TO_FAMILY(cpuid);
275 		model = CPUID_TO_MODEL(cpuid);
276 	}
277 
278 	switch (family) {
279 	case 0x0f:
280 		/*
281 		 * Thermaltrip Status Register
282 		 *
283 		 * - ThermSenseCoreSel
284 		 *
285 		 * Revision F & G:	0 - Core1, 1 - Core0
286 		 * Other:		0 - Core0, 1 - Core1
287 		 *
288 		 * - CurTmp
289 		 *
290 		 * Revision G:		bits 23-14
291 		 * Other:		bits 23-16
292 		 *
293 		 * XXX According to the BKDG, CurTmp, ThermSenseSel and
294 		 * ThermSenseCoreSel bits were introduced in Revision F
295 		 * but CurTmp seems working fine as early as Revision C.
296 		 * However, it is not clear whether ThermSenseSel and/or
297 		 * ThermSenseCoreSel work in undocumented cases as well.
298 		 * In fact, the Linux driver suggests it may not work but
299 		 * we just assume it does until we find otherwise.
300 		 *
301 		 * XXX According to Linux, CurTmp starts at -28C on
302 		 * Socket AM2 Revision G processors, which is not
303 		 * documented anywhere.
304 		 */
305 		if (model >= 0x40)
306 			sc->sc_flags |= AMDTEMP_FLAG_CS_SWAP;
307 		if (model >= 0x60 && model != 0xc1) {
308 			do_cpuid(0x80000001, regs);
309 			bid = (regs[1] >> 9) & 0x1f;
310 			switch (model) {
311 			case 0x68: /* Socket S1g1 */
312 			case 0x6c:
313 			case 0x7c:
314 				break;
315 			case 0x6b: /* Socket AM2 and ASB1 (2 cores) */
316 				if (bid != 0x0b && bid != 0x0c)
317 					sc->sc_flags |=
318 					    AMDTEMP_FLAG_ALT_OFFSET;
319 				break;
320 			case 0x6f: /* Socket AM2 and ASB1 (1 core) */
321 			case 0x7f:
322 				if (bid != 0x07 && bid != 0x09 &&
323 				    bid != 0x0c)
324 					sc->sc_flags |=
325 					    AMDTEMP_FLAG_ALT_OFFSET;
326 				break;
327 			default:
328 				sc->sc_flags |= AMDTEMP_FLAG_ALT_OFFSET;
329 			}
330 			sc->sc_flags |= AMDTEMP_FLAG_CT_10BIT;
331 		}
332 
333 		/*
334 		 * There are two sensors per core.
335 		 */
336 		sc->sc_ntemps = 2;
337 
338 		sc->sc_gettemp = amdtemp_gettemp0f;
339 		break;
340 	case 0x10:
341 		/*
342 		 * Erratum 319 Inaccurate Temperature Measurement
343 		 *
344 		 * http://support.amd.com/us/Processor_TechDocs/41322.pdf
345 		 */
346 		do_cpuid(0x80000001, regs);
347 		switch ((regs[1] >> 28) & 0xf) {
348 		case 0:	/* Socket F */
349 			erratum319 = 1;
350 			break;
351 		case 1:	/* Socket AM2+ or AM3 */
352 			if ((pci_cfgregread(pci_get_bus(dev),
353 			    pci_get_slot(dev), 2, AMDTEMP_DRAM_CONF_HIGH, 2) &
354 			    AMDTEMP_DRAM_MODE_DDR3) != 0 || model > 0x04 ||
355 			    (model == 0x04 && (cpuid & CPUID_STEPPING) >= 3))
356 				break;
357 			/* XXX 00100F42h (RB-C2) exists in both formats. */
358 			erratum319 = 1;
359 			break;
360 		}
361 		/* FALLTHROUGH */
362 	case 0x11:
363 	case 0x12:
364 	case 0x14:
365 	case 0x15:
366 	case 0x16:
367 		/*
368 		 * There is only one sensor per package.
369 		 */
370 		sc->sc_ntemps = 1;
371 
372 		sc->sc_gettemp = amdtemp_gettemp;
373 		break;
374 	case 0x17:
375 		sc->sc_ntemps = 1;
376 		sc->sc_gettemp = amdtemp_gettemp17h;
377 		sc->sc_smn = device_find_child(
378 		    device_get_parent(dev), "amdsmn", -1);
379 		if (sc->sc_smn == NULL) {
380 			if (bootverbose)
381 				device_printf(dev, "No SMN device found\n");
382 			return (ENXIO);
383 		}
384 		break;
385 	}
386 
387 	/* Find number of cores per package. */
388 	sc->sc_ncores = (amd_feature2 & AMDID2_CMP) != 0 ?
389 	    (cpu_procinfo2 & AMDID_CMP_CORES) + 1 : 1;
390 	if (sc->sc_ncores > MAXCPU)
391 		return (ENXIO);
392 
393 	if (erratum319)
394 		device_printf(dev,
395 		    "Erratum 319: temperature measurement may be inaccurate\n");
396 	if (bootverbose)
397 		device_printf(dev, "Found %d cores and %d sensors.\n",
398 		    sc->sc_ncores,
399 		    sc->sc_ntemps > 1 ? sc->sc_ntemps * sc->sc_ncores : 1);
400 
401 	/*
402 	 * dev.amdtemp.N tree.
403 	 */
404 	unit = device_get_unit(dev);
405 	snprintf(tn, sizeof(tn), "dev.amdtemp.%d.sensor_offset", unit);
406 	TUNABLE_INT_FETCH(tn, &sc->sc_offset);
407 
408 	sysctlctx = device_get_sysctl_ctx(dev);
409 	SYSCTL_ADD_INT(sysctlctx,
410 	    SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO,
411 	    "sensor_offset", CTLFLAG_RW, &sc->sc_offset, 0,
412 	    "Temperature sensor offset");
413 	sysctlnode = SYSCTL_ADD_NODE(sysctlctx,
414 	    SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO,
415 	    "core0", CTLFLAG_RD, 0, "Core 0");
416 
417 	SYSCTL_ADD_PROC(sysctlctx,
418 	    SYSCTL_CHILDREN(sysctlnode),
419 	    OID_AUTO, "sensor0", CTLTYPE_INT | CTLFLAG_RD,
420 	    dev, CORE0_SENSOR0, amdtemp_sysctl, "IK",
421 	    "Core 0 / Sensor 0 temperature");
422 
423 	if (sc->sc_ntemps > 1) {
424 		SYSCTL_ADD_PROC(sysctlctx,
425 		    SYSCTL_CHILDREN(sysctlnode),
426 		    OID_AUTO, "sensor1", CTLTYPE_INT | CTLFLAG_RD,
427 		    dev, CORE0_SENSOR1, amdtemp_sysctl, "IK",
428 		    "Core 0 / Sensor 1 temperature");
429 
430 		if (sc->sc_ncores > 1) {
431 			sysctlnode = SYSCTL_ADD_NODE(sysctlctx,
432 			    SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
433 			    OID_AUTO, "core1", CTLFLAG_RD, 0, "Core 1");
434 
435 			SYSCTL_ADD_PROC(sysctlctx,
436 			    SYSCTL_CHILDREN(sysctlnode),
437 			    OID_AUTO, "sensor0", CTLTYPE_INT | CTLFLAG_RD,
438 			    dev, CORE1_SENSOR0, amdtemp_sysctl, "IK",
439 			    "Core 1 / Sensor 0 temperature");
440 
441 			SYSCTL_ADD_PROC(sysctlctx,
442 			    SYSCTL_CHILDREN(sysctlnode),
443 			    OID_AUTO, "sensor1", CTLTYPE_INT | CTLFLAG_RD,
444 			    dev, CORE1_SENSOR1, amdtemp_sysctl, "IK",
445 			    "Core 1 / Sensor 1 temperature");
446 		}
447 	}
448 
449 	/*
450 	 * Try to create dev.cpu sysctl entries and setup intrhook function.
451 	 * This is needed because the cpu driver may be loaded late on boot,
452 	 * after us.
453 	 */
454 	amdtemp_intrhook(dev);
455 	sc->sc_ich.ich_func = amdtemp_intrhook;
456 	sc->sc_ich.ich_arg = dev;
457 	if (config_intrhook_establish(&sc->sc_ich) != 0) {
458 		device_printf(dev, "config_intrhook_establish failed!\n");
459 		return (ENXIO);
460 	}
461 
462 	return (0);
463 }
464 
465 void
466 amdtemp_intrhook(void *arg)
467 {
468 	struct amdtemp_softc *sc;
469 	struct sysctl_ctx_list *sysctlctx;
470 	device_t dev = (device_t)arg;
471 	device_t acpi, cpu, nexus;
472 	amdsensor_t sensor;
473 	int i;
474 
475 	sc = device_get_softc(dev);
476 
477 	/*
478 	 * dev.cpu.N.temperature.
479 	 */
480 	nexus = device_find_child(root_bus, "nexus", 0);
481 	acpi = device_find_child(nexus, "acpi", 0);
482 
483 	for (i = 0; i < sc->sc_ncores; i++) {
484 		if (sc->sc_sysctl_cpu[i] != NULL)
485 			continue;
486 		cpu = device_find_child(acpi, "cpu",
487 		    device_get_unit(dev) * sc->sc_ncores + i);
488 		if (cpu != NULL) {
489 			sysctlctx = device_get_sysctl_ctx(cpu);
490 
491 			sensor = sc->sc_ntemps > 1 ?
492 			    (i == 0 ? CORE0 : CORE1) : CORE0_SENSOR0;
493 			sc->sc_sysctl_cpu[i] = SYSCTL_ADD_PROC(sysctlctx,
494 			    SYSCTL_CHILDREN(device_get_sysctl_tree(cpu)),
495 			    OID_AUTO, "temperature", CTLTYPE_INT | CTLFLAG_RD,
496 			    dev, sensor, amdtemp_sysctl, "IK",
497 			    "Current temparature");
498 		}
499 	}
500 	if (sc->sc_ich.ich_arg != NULL)
501 		config_intrhook_disestablish(&sc->sc_ich);
502 }
503 
504 int
505 amdtemp_detach(device_t dev)
506 {
507 	struct amdtemp_softc *sc = device_get_softc(dev);
508 	int i;
509 
510 	for (i = 0; i < sc->sc_ncores; i++)
511 		if (sc->sc_sysctl_cpu[i] != NULL)
512 			sysctl_remove_oid(sc->sc_sysctl_cpu[i], 1, 0);
513 
514 	/* NewBus removes the dev.amdtemp.N tree by itself. */
515 
516 	return (0);
517 }
518 
519 static int
520 amdtemp_sysctl(SYSCTL_HANDLER_ARGS)
521 {
522 	device_t dev = (device_t)arg1;
523 	struct amdtemp_softc *sc = device_get_softc(dev);
524 	amdsensor_t sensor = (amdsensor_t)arg2;
525 	int32_t auxtemp[2], temp;
526 	int error;
527 
528 	switch (sensor) {
529 	case CORE0:
530 		auxtemp[0] = sc->sc_gettemp(dev, CORE0_SENSOR0);
531 		auxtemp[1] = sc->sc_gettemp(dev, CORE0_SENSOR1);
532 		temp = imax(auxtemp[0], auxtemp[1]);
533 		break;
534 	case CORE1:
535 		auxtemp[0] = sc->sc_gettemp(dev, CORE1_SENSOR0);
536 		auxtemp[1] = sc->sc_gettemp(dev, CORE1_SENSOR1);
537 		temp = imax(auxtemp[0], auxtemp[1]);
538 		break;
539 	default:
540 		temp = sc->sc_gettemp(dev, sensor);
541 		break;
542 	}
543 	error = sysctl_handle_int(oidp, &temp, 0, req);
544 
545 	return (error);
546 }
547 
548 #define	AMDTEMP_ZERO_C_TO_K	2731
549 
550 static int32_t
551 amdtemp_gettemp0f(device_t dev, amdsensor_t sensor)
552 {
553 	struct amdtemp_softc *sc = device_get_softc(dev);
554 	uint32_t mask, offset, temp;
555 
556 	/* Set Sensor/Core selector. */
557 	temp = pci_read_config(dev, AMDTEMP_THERMTP_STAT, 1);
558 	temp &= ~(AMDTEMP_TTSR_SELCORE | AMDTEMP_TTSR_SELSENSOR);
559 	switch (sensor) {
560 	case CORE0_SENSOR1:
561 		temp |= AMDTEMP_TTSR_SELSENSOR;
562 		/* FALLTHROUGH */
563 	case CORE0_SENSOR0:
564 	case CORE0:
565 		if ((sc->sc_flags & AMDTEMP_FLAG_CS_SWAP) != 0)
566 			temp |= AMDTEMP_TTSR_SELCORE;
567 		break;
568 	case CORE1_SENSOR1:
569 		temp |= AMDTEMP_TTSR_SELSENSOR;
570 		/* FALLTHROUGH */
571 	case CORE1_SENSOR0:
572 	case CORE1:
573 		if ((sc->sc_flags & AMDTEMP_FLAG_CS_SWAP) == 0)
574 			temp |= AMDTEMP_TTSR_SELCORE;
575 		break;
576 	}
577 	pci_write_config(dev, AMDTEMP_THERMTP_STAT, temp, 1);
578 
579 	mask = (sc->sc_flags & AMDTEMP_FLAG_CT_10BIT) != 0 ? 0x3ff : 0x3fc;
580 	offset = (sc->sc_flags & AMDTEMP_FLAG_ALT_OFFSET) != 0 ? 28 : 49;
581 	temp = pci_read_config(dev, AMDTEMP_THERMTP_STAT, 4);
582 	temp = ((temp >> 14) & mask) * 5 / 2;
583 	temp += AMDTEMP_ZERO_C_TO_K + (sc->sc_offset - offset) * 10;
584 
585 	return (temp);
586 }
587 
588 static int32_t
589 amdtemp_gettemp(device_t dev, amdsensor_t sensor)
590 {
591 	struct amdtemp_softc *sc = device_get_softc(dev);
592 	uint32_t temp;
593 
594 	temp = pci_read_config(dev, AMDTEMP_REPTMP_CTRL, 4);
595 	temp = ((temp >> 21) & 0x7ff) * 5 / 4;
596 	temp += AMDTEMP_ZERO_C_TO_K + sc->sc_offset * 10;
597 
598 	return (temp);
599 }
600 
601 static int32_t
602 amdtemp_gettemp17h(device_t dev, amdsensor_t sensor)
603 {
604 	struct amdtemp_softc *sc = device_get_softc(dev);
605 	uint32_t temp, val;
606 	int error;
607 
608 	error = amdsmn_read(sc->sc_smn, AMDTEMP_17H_CUR_TMP, &val);
609 	KASSERT(error == 0, ("amdsmn_read"));
610 
611 	temp = ((val >> 21) & 0x7ff) * 5 / 4;
612 	if ((val & AMDTEMP_17H_CUR_TMP_RANGE_SEL) != 0)
613 		temp -= AMDTEMP_17H_CUR_TMP_RANGE_OFF;
614 	temp += AMDTEMP_ZERO_C_TO_K + sc->sc_offset * 10;
615 
616 	return (temp);
617 }
618