12025cf9eSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
23e8c4d31SAmit Kucheria /* intel_pch_thermal.c - Intel PCH Thermal driver
33e8c4d31SAmit Kucheria  *
43e8c4d31SAmit Kucheria  * Copyright (c) 2015, Intel Corporation.
53e8c4d31SAmit Kucheria  *
63e8c4d31SAmit Kucheria  * Authors:
73e8c4d31SAmit Kucheria  *     Tushar Dave <tushar.n.dave@intel.com>
83e8c4d31SAmit Kucheria  */
93e8c4d31SAmit Kucheria 
10ef63b043SSumeet Pawnikar #include <linux/acpi.h>
11ef63b043SSumeet Pawnikar #include <linux/delay.h>
123e8c4d31SAmit Kucheria #include <linux/module.h>
133e8c4d31SAmit Kucheria #include <linux/init.h>
143e8c4d31SAmit Kucheria #include <linux/pci.h>
153e8c4d31SAmit Kucheria #include <linux/pm.h>
16ef63b043SSumeet Pawnikar #include <linux/suspend.h>
17ef63b043SSumeet Pawnikar #include <linux/thermal.h>
18ef63b043SSumeet Pawnikar #include <linux/types.h>
19ef63b043SSumeet Pawnikar #include <linux/units.h>
203e8c4d31SAmit Kucheria 
213e8c4d31SAmit Kucheria /* Intel PCH thermal Device IDs */
223e8c4d31SAmit Kucheria #define PCH_THERMAL_DID_HSW_1	0x9C24 /* Haswell PCH */
233e8c4d31SAmit Kucheria #define PCH_THERMAL_DID_HSW_2	0x8C24 /* Haswell PCH */
243e8c4d31SAmit Kucheria #define PCH_THERMAL_DID_WPT	0x9CA4 /* Wildcat Point */
253e8c4d31SAmit Kucheria #define PCH_THERMAL_DID_SKL	0x9D31 /* Skylake PCH */
263e8c4d31SAmit Kucheria #define PCH_THERMAL_DID_SKL_H	0xA131 /* Skylake PCH 100 series */
273e8c4d31SAmit Kucheria #define PCH_THERMAL_DID_CNL	0x9Df9 /* CNL PCH */
283e8c4d31SAmit Kucheria #define PCH_THERMAL_DID_CNL_H	0xA379 /* CNL-H PCH */
29c569e805SSumeet Pawnikar #define PCH_THERMAL_DID_CNL_LP	0x02F9 /* CNL-LP PCH */
3035709c4eSGayatri Kammela #define PCH_THERMAL_DID_CML_H	0X06F9 /* CML-H PCH */
31e78acf7eSAndres Freund #define PCH_THERMAL_DID_LWB	0xA1B1 /* Lewisburg PCH */
3240dc1929STim Zimmermann #define PCH_THERMAL_DID_WBG	0x8D24 /* Wellsburg PCH */
333e8c4d31SAmit Kucheria 
343e8c4d31SAmit Kucheria /* Wildcat Point-LP  PCH Thermal registers */
353e8c4d31SAmit Kucheria #define WPT_TEMP	0x0000	/* Temperature */
363e8c4d31SAmit Kucheria #define WPT_TSC	0x04	/* Thermal Sensor Control */
373e8c4d31SAmit Kucheria #define WPT_TSS	0x06	/* Thermal Sensor Status */
383e8c4d31SAmit Kucheria #define WPT_TSEL	0x08	/* Thermal Sensor Enable and Lock */
393e8c4d31SAmit Kucheria #define WPT_TSREL	0x0A	/* Thermal Sensor Report Enable and Lock */
403e8c4d31SAmit Kucheria #define WPT_TSMIC	0x0C	/* Thermal Sensor SMI Control */
413e8c4d31SAmit Kucheria #define WPT_CTT	0x0010	/* Catastrophic Trip Point */
42ef63b043SSumeet Pawnikar #define WPT_TSPM	0x001C	/* Thermal Sensor Power Management */
433e8c4d31SAmit Kucheria #define WPT_TAHV	0x0014	/* Thermal Alert High Value */
443e8c4d31SAmit Kucheria #define WPT_TALV	0x0018	/* Thermal Alert Low Value */
453e8c4d31SAmit Kucheria #define WPT_TL		0x00000040	/* Throttle Value */
463e8c4d31SAmit Kucheria #define WPT_PHL	0x0060	/* PCH Hot Level */
473e8c4d31SAmit Kucheria #define WPT_PHLC	0x62	/* PHL Control */
483e8c4d31SAmit Kucheria #define WPT_TAS	0x80	/* Thermal Alert Status */
493e8c4d31SAmit Kucheria #define WPT_TSPIEN	0x82	/* PCI Interrupt Event Enables */
503e8c4d31SAmit Kucheria #define WPT_TSGPEN	0x84	/* General Purpose Event Enables */
513e8c4d31SAmit Kucheria 
523e8c4d31SAmit Kucheria /*  Wildcat Point-LP  PCH Thermal Register bit definitions */
533e8c4d31SAmit Kucheria #define WPT_TEMP_TSR	0x01ff	/* Temp TS Reading */
543e8c4d31SAmit Kucheria #define WPT_TSC_CPDE	0x01	/* Catastrophic Power-Down Enable */
553e8c4d31SAmit Kucheria #define WPT_TSS_TSDSS	0x10	/* Thermal Sensor Dynamic Shutdown Status */
563e8c4d31SAmit Kucheria #define WPT_TSS_GPES	0x08	/* GPE status */
573e8c4d31SAmit Kucheria #define WPT_TSEL_ETS	0x01    /* Enable TS */
583e8c4d31SAmit Kucheria #define WPT_TSEL_PLDB	0x80	/* TSEL Policy Lock-Down Bit */
593e8c4d31SAmit Kucheria #define WPT_TL_TOL	0x000001FF	/* T0 Level */
603e8c4d31SAmit Kucheria #define WPT_TL_T1L	0x1ff00000	/* T1 Level */
613e8c4d31SAmit Kucheria #define WPT_TL_TTEN	0x20000000	/* TT Enable */
623e8c4d31SAmit Kucheria 
63ef63b043SSumeet Pawnikar /* Resolution of 1/2 degree C and an offset of -50C */
64ef63b043SSumeet Pawnikar #define PCH_TEMP_OFFSET	(-50)
65ef63b043SSumeet Pawnikar #define GET_WPT_TEMP(x)	((x) * MILLIDEGREE_PER_DEGREE / 2 + WPT_TEMP_OFFSET)
66ef63b043SSumeet Pawnikar #define WPT_TEMP_OFFSET	(PCH_TEMP_OFFSET * MILLIDEGREE_PER_DEGREE)
67ef63b043SSumeet Pawnikar #define GET_PCH_TEMP(x)	(((x) / 2) + PCH_TEMP_OFFSET)
68ef63b043SSumeet Pawnikar 
69fee19c69SDaniel Lezcano #define PCH_MAX_TRIPS 3 /* critical, hot, passive */
70fee19c69SDaniel Lezcano 
71ef63b043SSumeet Pawnikar /* Amount of time for each cooling delay, 100ms by default for now */
72ef63b043SSumeet Pawnikar static unsigned int delay_timeout = 100;
73ef63b043SSumeet Pawnikar module_param(delay_timeout, int, 0644);
74ef63b043SSumeet Pawnikar MODULE_PARM_DESC(delay_timeout, "amount of time delay for each iteration.");
75ef63b043SSumeet Pawnikar 
7692923028SZhang Rui /* Number of iterations for cooling delay, 600 counts by default for now */
7792923028SZhang Rui static unsigned int delay_cnt = 600;
78ef63b043SSumeet Pawnikar module_param(delay_cnt, int, 0644);
79ef63b043SSumeet Pawnikar MODULE_PARM_DESC(delay_cnt, "total number of iterations for time delay.");
80ef63b043SSumeet Pawnikar 
813e8c4d31SAmit Kucheria static char driver_name[] = "Intel PCH thermal driver";
823e8c4d31SAmit Kucheria 
833e8c4d31SAmit Kucheria struct pch_thermal_device {
843e8c4d31SAmit Kucheria 	void __iomem *hw_base;
853e8c4d31SAmit Kucheria 	struct pci_dev *pdev;
863e8c4d31SAmit Kucheria 	struct thermal_zone_device *tzd;
87fee19c69SDaniel Lezcano 	struct thermal_trip trips[PCH_MAX_TRIPS];
883e8c4d31SAmit Kucheria 	bool bios_enabled;
893e8c4d31SAmit Kucheria };
903e8c4d31SAmit Kucheria 
913e8c4d31SAmit Kucheria #ifdef CONFIG_ACPI
923e8c4d31SAmit Kucheria /*
933e8c4d31SAmit Kucheria  * On some platforms, there is a companion ACPI device, which adds
943e8c4d31SAmit Kucheria  * passive trip temperature using _PSV method. There is no specific
953e8c4d31SAmit Kucheria  * passive temperature setting in MMIO interface of this PCI device.
963e8c4d31SAmit Kucheria  */
972cee7356SRafael J. Wysocki static int pch_wpt_add_acpi_psv_trip(struct pch_thermal_device *ptd, int trip)
983e8c4d31SAmit Kucheria {
993e8c4d31SAmit Kucheria 	struct acpi_device *adev;
100dd3b3d16SRafael J. Wysocki 	int temp;
1013e8c4d31SAmit Kucheria 
1023e8c4d31SAmit Kucheria 	adev = ACPI_COMPANION(&ptd->pdev->dev);
103fee19c69SDaniel Lezcano 	if (!adev)
1042cee7356SRafael J. Wysocki 		return 0;
1053e8c4d31SAmit Kucheria 
106dd3b3d16SRafael J. Wysocki 	if (thermal_acpi_passive_trip_temp(adev, &temp) || temp <= 0)
1072cee7356SRafael J. Wysocki 		return 0;
1083e8c4d31SAmit Kucheria 
1092cee7356SRafael J. Wysocki 	ptd->trips[trip].type = THERMAL_TRIP_PASSIVE;
1102cee7356SRafael J. Wysocki 	ptd->trips[trip].temperature = temp;
1112cee7356SRafael J. Wysocki 	return 1;
1123e8c4d31SAmit Kucheria }
1133e8c4d31SAmit Kucheria #else
1142cee7356SRafael J. Wysocki static int pch_wpt_add_acpi_psv_trip(struct pch_thermal_device *ptd, int trip)
1153e8c4d31SAmit Kucheria {
1162cee7356SRafael J. Wysocki 	return 0;
1173e8c4d31SAmit Kucheria }
1183e8c4d31SAmit Kucheria #endif
1193e8c4d31SAmit Kucheria 
12028708e19SZhang Rui /* Cool the PCH when it's overheat in .suspend_noirq phase */
1211aa4f925SRafael J. Wysocki static int pch_suspend(struct pch_thermal_device *ptd)
1223e8c4d31SAmit Kucheria {
1233e8c4d31SAmit Kucheria 	u8 tsel;
124bd30d075SZhang Rui 	int pch_delay_cnt = 0;
125ef63b043SSumeet Pawnikar 	u16 pch_thr_temp, pch_cur_temp;
1263e8c4d31SAmit Kucheria 
127ef63b043SSumeet Pawnikar 	/* Shutdown the thermal sensor if it is not enabled by BIOS */
128ef63b043SSumeet Pawnikar 	if (!ptd->bios_enabled) {
129ef63b043SSumeet Pawnikar 		tsel = readb(ptd->hw_base + WPT_TSEL);
130ef63b043SSumeet Pawnikar 		writeb(tsel & 0xFE, ptd->hw_base + WPT_TSEL);
131ef63b043SSumeet Pawnikar 		return 0;
132ef63b043SSumeet Pawnikar 	}
133ef63b043SSumeet Pawnikar 
134ef63b043SSumeet Pawnikar 	/* Do not check temperature if it is not s2idle */
135ef63b043SSumeet Pawnikar 	if (pm_suspend_via_firmware())
136ef63b043SSumeet Pawnikar 		return 0;
1373e8c4d31SAmit Kucheria 
138ef63b043SSumeet Pawnikar 	/* Get the PCH temperature threshold value */
139ef63b043SSumeet Pawnikar 	pch_thr_temp = GET_PCH_TEMP(WPT_TEMP_TSR & readw(ptd->hw_base + WPT_TSPM));
140ef63b043SSumeet Pawnikar 
141ef63b043SSumeet Pawnikar 	/* Get the PCH current temperature value */
142ef63b043SSumeet Pawnikar 	pch_cur_temp = GET_PCH_TEMP(WPT_TEMP_TSR & readw(ptd->hw_base + WPT_TEMP));
143ef63b043SSumeet Pawnikar 
144ef63b043SSumeet Pawnikar 	/*
145ef63b043SSumeet Pawnikar 	 * If current PCH temperature is higher than configured PCH threshold
146ef63b043SSumeet Pawnikar 	 * value, run some delay loop with sleep to let the current temperature
147ef63b043SSumeet Pawnikar 	 * go down below the threshold value which helps to allow system enter
148ef63b043SSumeet Pawnikar 	 * lower power S0ix suspend state. Even after delay loop if PCH current
149ef63b043SSumeet Pawnikar 	 * temperature stays above threshold, notify the warning message
150ef63b043SSumeet Pawnikar 	 * which helps to indentify the reason why S0ix entry was rejected.
151ef63b043SSumeet Pawnikar 	 */
152bd30d075SZhang Rui 	while (pch_delay_cnt < delay_cnt) {
15392923028SZhang Rui 		if (pch_cur_temp < pch_thr_temp)
15492923028SZhang Rui 			break;
15592923028SZhang Rui 
156bd30d075SZhang Rui 		if (pm_wakeup_pending()) {
157bd30d075SZhang Rui 			dev_warn(&ptd->pdev->dev, "Wakeup event detected, abort cooling\n");
158bd30d075SZhang Rui 			return 0;
159bd30d075SZhang Rui 		}
160ef63b043SSumeet Pawnikar 
161bd30d075SZhang Rui 		pch_delay_cnt++;
162bd30d075SZhang Rui 		dev_dbg(&ptd->pdev->dev,
163ef63b043SSumeet Pawnikar 			"CPU-PCH current temp [%dC] higher than the threshold temp [%dC], sleep %d times for %d ms duration\n",
164ef63b043SSumeet Pawnikar 			pch_cur_temp, pch_thr_temp, pch_delay_cnt, delay_timeout);
165ef63b043SSumeet Pawnikar 		msleep(delay_timeout);
166ef63b043SSumeet Pawnikar 		/* Read the PCH current temperature for next cycle. */
167ef63b043SSumeet Pawnikar 		pch_cur_temp = GET_PCH_TEMP(WPT_TEMP_TSR & readw(ptd->hw_base + WPT_TEMP));
168ef63b043SSumeet Pawnikar 	}
169ef63b043SSumeet Pawnikar 
17092923028SZhang Rui 	if (pch_cur_temp >= pch_thr_temp)
171ef63b043SSumeet Pawnikar 		dev_warn(&ptd->pdev->dev,
172bd30d075SZhang Rui 			"CPU-PCH is hot [%dC] after %d ms delay. S0ix might fail\n",
173bd30d075SZhang Rui 			pch_cur_temp, pch_delay_cnt * delay_timeout);
174bd30d075SZhang Rui 	else {
175bd30d075SZhang Rui 		if (pch_delay_cnt)
176bd30d075SZhang Rui 			dev_info(&ptd->pdev->dev,
177bd30d075SZhang Rui 				"CPU-PCH is cool [%dC] after %d ms delay\n",
178bd30d075SZhang Rui 				pch_cur_temp, pch_delay_cnt * delay_timeout);
179ef63b043SSumeet Pawnikar 		else
180ef63b043SSumeet Pawnikar 			dev_info(&ptd->pdev->dev,
181bd30d075SZhang Rui 				"CPU-PCH is cool [%dC]\n",
182bd30d075SZhang Rui 				pch_cur_temp);
183bd30d075SZhang Rui 	}
1843e8c4d31SAmit Kucheria 
1853e8c4d31SAmit Kucheria 	return 0;
1863e8c4d31SAmit Kucheria }
1873e8c4d31SAmit Kucheria 
1881aa4f925SRafael J. Wysocki static int pch_resume(struct pch_thermal_device *ptd)
1893e8c4d31SAmit Kucheria {
1903e8c4d31SAmit Kucheria 	u8 tsel;
1913e8c4d31SAmit Kucheria 
1923e8c4d31SAmit Kucheria 	if (ptd->bios_enabled)
1933e8c4d31SAmit Kucheria 		return 0;
1943e8c4d31SAmit Kucheria 
1953e8c4d31SAmit Kucheria 	tsel = readb(ptd->hw_base + WPT_TSEL);
1963e8c4d31SAmit Kucheria 
1973e8c4d31SAmit Kucheria 	writeb(tsel | WPT_TSEL_ETS, ptd->hw_base + WPT_TSEL);
1983e8c4d31SAmit Kucheria 
1993e8c4d31SAmit Kucheria 	return 0;
2003e8c4d31SAmit Kucheria }
2013e8c4d31SAmit Kucheria 
2023e8c4d31SAmit Kucheria static int pch_thermal_get_temp(struct thermal_zone_device *tzd, int *temp)
2033e8c4d31SAmit Kucheria {
2043e8c4d31SAmit Kucheria 	struct pch_thermal_device *ptd = tzd->devdata;
2053e8c4d31SAmit Kucheria 
206*35c87f94SRafael J. Wysocki 	*temp = GET_WPT_TEMP(WPT_TEMP_TSR & readw(ptd->hw_base + WPT_TEMP));
207558718f4SRafael J. Wysocki 	return 0;
2083e8c4d31SAmit Kucheria }
2093e8c4d31SAmit Kucheria 
21003671968SKai-Heng Feng static void pch_critical(struct thermal_zone_device *tzd)
21103671968SKai-Heng Feng {
21203671968SKai-Heng Feng 	dev_dbg(&tzd->device, "%s: critical temperature reached\n", tzd->type);
21303671968SKai-Heng Feng }
21403671968SKai-Heng Feng 
2153e8c4d31SAmit Kucheria static struct thermal_zone_device_ops tzd_ops = {
2163e8c4d31SAmit Kucheria 	.get_temp = pch_thermal_get_temp,
21703671968SKai-Heng Feng 	.critical = pch_critical,
2183e8c4d31SAmit Kucheria };
2193e8c4d31SAmit Kucheria 
2203e8c4d31SAmit Kucheria enum board_ids {
2213e8c4d31SAmit Kucheria 	board_hsw,
2223e8c4d31SAmit Kucheria 	board_wpt,
2233e8c4d31SAmit Kucheria 	board_skl,
2243e8c4d31SAmit Kucheria 	board_cnl,
22535709c4eSGayatri Kammela 	board_cml,
226e78acf7eSAndres Freund 	board_lwb,
22740dc1929STim Zimmermann 	board_wbg,
2283e8c4d31SAmit Kucheria };
2293e8c4d31SAmit Kucheria 
2303e8c4d31SAmit Kucheria static const struct board_info {
2313e8c4d31SAmit Kucheria 	const char *name;
2323e8c4d31SAmit Kucheria } board_info[] = {
2333e8c4d31SAmit Kucheria 	[board_hsw] = {
2343e8c4d31SAmit Kucheria 		.name = "pch_haswell",
2353e8c4d31SAmit Kucheria 	},
2363e8c4d31SAmit Kucheria 	[board_wpt] = {
2373e8c4d31SAmit Kucheria 		.name = "pch_wildcat_point",
2383e8c4d31SAmit Kucheria 	},
2393e8c4d31SAmit Kucheria 	[board_skl] = {
2403e8c4d31SAmit Kucheria 		.name = "pch_skylake",
2413e8c4d31SAmit Kucheria 	},
2423e8c4d31SAmit Kucheria 	[board_cnl] = {
2433e8c4d31SAmit Kucheria 		.name = "pch_cannonlake",
2443e8c4d31SAmit Kucheria 	},
24535709c4eSGayatri Kammela 	[board_cml] = {
24635709c4eSGayatri Kammela 		.name = "pch_cometlake",
247e78acf7eSAndres Freund 	},
248e78acf7eSAndres Freund 	[board_lwb] = {
249e78acf7eSAndres Freund 		.name = "pch_lewisburg",
250e78acf7eSAndres Freund 	},
25140dc1929STim Zimmermann 	[board_wbg] = {
25240dc1929STim Zimmermann 		.name = "pch_wellsburg",
25340dc1929STim Zimmermann 	},
2543e8c4d31SAmit Kucheria };
2553e8c4d31SAmit Kucheria 
2563e8c4d31SAmit Kucheria static int intel_pch_thermal_probe(struct pci_dev *pdev,
2573e8c4d31SAmit Kucheria 				   const struct pci_device_id *id)
2583e8c4d31SAmit Kucheria {
2593e8c4d31SAmit Kucheria 	enum board_ids board_id = id->driver_data;
2603e8c4d31SAmit Kucheria 	const struct board_info *bi = &board_info[board_id];
2613e8c4d31SAmit Kucheria 	struct pch_thermal_device *ptd;
262*35c87f94SRafael J. Wysocki 	int nr_trips = 0;
263*35c87f94SRafael J. Wysocki 	u16 trip_temp;
264*35c87f94SRafael J. Wysocki 	u8 tsel;
2653e8c4d31SAmit Kucheria 	int err;
2663e8c4d31SAmit Kucheria 
2673e8c4d31SAmit Kucheria 	ptd = devm_kzalloc(&pdev->dev, sizeof(*ptd), GFP_KERNEL);
2683e8c4d31SAmit Kucheria 	if (!ptd)
2693e8c4d31SAmit Kucheria 		return -ENOMEM;
2703e8c4d31SAmit Kucheria 
2713e8c4d31SAmit Kucheria 	pci_set_drvdata(pdev, ptd);
2723e8c4d31SAmit Kucheria 	ptd->pdev = pdev;
2733e8c4d31SAmit Kucheria 
2743e8c4d31SAmit Kucheria 	err = pci_enable_device(pdev);
2753e8c4d31SAmit Kucheria 	if (err) {
2763e8c4d31SAmit Kucheria 		dev_err(&pdev->dev, "failed to enable pci device\n");
2773e8c4d31SAmit Kucheria 		return err;
2783e8c4d31SAmit Kucheria 	}
2793e8c4d31SAmit Kucheria 
2803e8c4d31SAmit Kucheria 	err = pci_request_regions(pdev, driver_name);
2813e8c4d31SAmit Kucheria 	if (err) {
2823e8c4d31SAmit Kucheria 		dev_err(&pdev->dev, "failed to request pci region\n");
2833e8c4d31SAmit Kucheria 		goto error_disable;
2843e8c4d31SAmit Kucheria 	}
2853e8c4d31SAmit Kucheria 
2863e8c4d31SAmit Kucheria 	ptd->hw_base = pci_ioremap_bar(pdev, 0);
2873e8c4d31SAmit Kucheria 	if (!ptd->hw_base) {
2883e8c4d31SAmit Kucheria 		err = -ENOMEM;
2893e8c4d31SAmit Kucheria 		dev_err(&pdev->dev, "failed to map mem base\n");
2903e8c4d31SAmit Kucheria 		goto error_release;
2913e8c4d31SAmit Kucheria 	}
2923e8c4d31SAmit Kucheria 
293*35c87f94SRafael J. Wysocki 	/* Check if BIOS has already enabled thermal sensor */
294*35c87f94SRafael J. Wysocki 	if (WPT_TSEL_ETS & readb(ptd->hw_base + WPT_TSEL)) {
295*35c87f94SRafael J. Wysocki 		ptd->bios_enabled = true;
296*35c87f94SRafael J. Wysocki 		goto read_trips;
297*35c87f94SRafael J. Wysocki 	}
298*35c87f94SRafael J. Wysocki 
299*35c87f94SRafael J. Wysocki 	tsel = readb(ptd->hw_base + WPT_TSEL);
300*35c87f94SRafael J. Wysocki 	/*
301*35c87f94SRafael J. Wysocki 	 * When TSEL's Policy Lock-Down bit is 1, TSEL become RO.
302*35c87f94SRafael J. Wysocki 	 * If so, thermal sensor cannot enable. Bail out.
303*35c87f94SRafael J. Wysocki 	 */
304*35c87f94SRafael J. Wysocki 	if (tsel & WPT_TSEL_PLDB) {
305*35c87f94SRafael J. Wysocki 		dev_err(&ptd->pdev->dev, "Sensor can't be enabled\n");
306*35c87f94SRafael J. Wysocki 		err = -ENODEV;
3073e8c4d31SAmit Kucheria 		goto error_cleanup;
308558718f4SRafael J. Wysocki 	}
3093e8c4d31SAmit Kucheria 
310*35c87f94SRafael J. Wysocki 	writeb(tsel|WPT_TSEL_ETS, ptd->hw_base + WPT_TSEL);
311*35c87f94SRafael J. Wysocki 	if (!(WPT_TSEL_ETS & readb(ptd->hw_base + WPT_TSEL))) {
312*35c87f94SRafael J. Wysocki 		dev_err(&ptd->pdev->dev, "Sensor can't be enabled\n");
313*35c87f94SRafael J. Wysocki 		err = -ENODEV;
314*35c87f94SRafael J. Wysocki 		goto error_cleanup;
315*35c87f94SRafael J. Wysocki 	}
316*35c87f94SRafael J. Wysocki 
317*35c87f94SRafael J. Wysocki read_trips:
318*35c87f94SRafael J. Wysocki 	trip_temp = readw(ptd->hw_base + WPT_CTT);
319*35c87f94SRafael J. Wysocki 	trip_temp &= 0x1FF;
320*35c87f94SRafael J. Wysocki 	if (trip_temp) {
321*35c87f94SRafael J. Wysocki 		ptd->trips[nr_trips].temperature = GET_WPT_TEMP(trip_temp);
322*35c87f94SRafael J. Wysocki 		ptd->trips[nr_trips++].type = THERMAL_TRIP_CRITICAL;
323*35c87f94SRafael J. Wysocki 	}
324*35c87f94SRafael J. Wysocki 
325*35c87f94SRafael J. Wysocki 	trip_temp = readw(ptd->hw_base + WPT_PHL);
326*35c87f94SRafael J. Wysocki 	trip_temp &= 0x1FF;
327*35c87f94SRafael J. Wysocki 	if (trip_temp) {
328*35c87f94SRafael J. Wysocki 		ptd->trips[nr_trips].temperature = GET_WPT_TEMP(trip_temp);
329*35c87f94SRafael J. Wysocki 		ptd->trips[nr_trips++].type = THERMAL_TRIP_HOT;
330*35c87f94SRafael J. Wysocki 	}
331*35c87f94SRafael J. Wysocki 
332*35c87f94SRafael J. Wysocki 	nr_trips += pch_wpt_add_acpi_psv_trip(ptd, nr_trips);
333*35c87f94SRafael J. Wysocki 
334fee19c69SDaniel Lezcano 	ptd->tzd = thermal_zone_device_register_with_trips(bi->name, ptd->trips,
335fee19c69SDaniel Lezcano 							   nr_trips, 0, ptd,
3363e8c4d31SAmit Kucheria 							   &tzd_ops, NULL, 0, 0);
3373e8c4d31SAmit Kucheria 	if (IS_ERR(ptd->tzd)) {
3383e8c4d31SAmit Kucheria 		dev_err(&pdev->dev, "Failed to register thermal zone %s\n",
3393e8c4d31SAmit Kucheria 			bi->name);
3403e8c4d31SAmit Kucheria 		err = PTR_ERR(ptd->tzd);
3413e8c4d31SAmit Kucheria 		goto error_cleanup;
3423e8c4d31SAmit Kucheria 	}
343bbcf90c0SAndrzej Pietrasiewicz 	err = thermal_zone_device_enable(ptd->tzd);
344bbcf90c0SAndrzej Pietrasiewicz 	if (err)
345bbcf90c0SAndrzej Pietrasiewicz 		goto err_unregister;
3463e8c4d31SAmit Kucheria 
3473e8c4d31SAmit Kucheria 	return 0;
3483e8c4d31SAmit Kucheria 
349bbcf90c0SAndrzej Pietrasiewicz err_unregister:
350bbcf90c0SAndrzej Pietrasiewicz 	thermal_zone_device_unregister(ptd->tzd);
3513e8c4d31SAmit Kucheria error_cleanup:
3523e8c4d31SAmit Kucheria 	iounmap(ptd->hw_base);
3533e8c4d31SAmit Kucheria error_release:
3543e8c4d31SAmit Kucheria 	pci_release_regions(pdev);
3553e8c4d31SAmit Kucheria error_disable:
3563e8c4d31SAmit Kucheria 	pci_disable_device(pdev);
3573e8c4d31SAmit Kucheria 	dev_err(&pdev->dev, "pci device failed to probe\n");
3583e8c4d31SAmit Kucheria 	return err;
3593e8c4d31SAmit Kucheria }
3603e8c4d31SAmit Kucheria 
3613e8c4d31SAmit Kucheria static void intel_pch_thermal_remove(struct pci_dev *pdev)
3623e8c4d31SAmit Kucheria {
3633e8c4d31SAmit Kucheria 	struct pch_thermal_device *ptd = pci_get_drvdata(pdev);
3643e8c4d31SAmit Kucheria 
3653e8c4d31SAmit Kucheria 	thermal_zone_device_unregister(ptd->tzd);
3663e8c4d31SAmit Kucheria 	iounmap(ptd->hw_base);
3673e8c4d31SAmit Kucheria 	pci_set_drvdata(pdev, NULL);
36866dd8b80SChuhong Yuan 	pci_release_regions(pdev);
3693e8c4d31SAmit Kucheria 	pci_disable_device(pdev);
3703e8c4d31SAmit Kucheria }
3713e8c4d31SAmit Kucheria 
37228708e19SZhang Rui static int intel_pch_thermal_suspend_noirq(struct device *device)
3733e8c4d31SAmit Kucheria {
37497e9cafeSChuhong Yuan 	struct pch_thermal_device *ptd = dev_get_drvdata(device);
3753e8c4d31SAmit Kucheria 
37686cb1004SRafael J. Wysocki 	return pch_suspend(ptd);
3773e8c4d31SAmit Kucheria }
3783e8c4d31SAmit Kucheria 
3793e8c4d31SAmit Kucheria static int intel_pch_thermal_resume(struct device *device)
3803e8c4d31SAmit Kucheria {
38197e9cafeSChuhong Yuan 	struct pch_thermal_device *ptd = dev_get_drvdata(device);
3823e8c4d31SAmit Kucheria 
38386cb1004SRafael J. Wysocki 	return pch_resume(ptd);
3843e8c4d31SAmit Kucheria }
3853e8c4d31SAmit Kucheria 
3863e8c4d31SAmit Kucheria static const struct pci_device_id intel_pch_thermal_id[] = {
3873e8c4d31SAmit Kucheria 	{ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCH_THERMAL_DID_HSW_1),
3883e8c4d31SAmit Kucheria 		.driver_data = board_hsw, },
3893e8c4d31SAmit Kucheria 	{ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCH_THERMAL_DID_HSW_2),
3903e8c4d31SAmit Kucheria 		.driver_data = board_hsw, },
3913e8c4d31SAmit Kucheria 	{ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCH_THERMAL_DID_WPT),
3923e8c4d31SAmit Kucheria 		.driver_data = board_wpt, },
3933e8c4d31SAmit Kucheria 	{ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCH_THERMAL_DID_SKL),
3943e8c4d31SAmit Kucheria 		.driver_data = board_skl, },
3953e8c4d31SAmit Kucheria 	{ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCH_THERMAL_DID_SKL_H),
3963e8c4d31SAmit Kucheria 		.driver_data = board_skl, },
3973e8c4d31SAmit Kucheria 	{ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCH_THERMAL_DID_CNL),
3983e8c4d31SAmit Kucheria 		.driver_data = board_cnl, },
3993e8c4d31SAmit Kucheria 	{ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCH_THERMAL_DID_CNL_H),
4003e8c4d31SAmit Kucheria 		.driver_data = board_cnl, },
401c569e805SSumeet Pawnikar 	{ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCH_THERMAL_DID_CNL_LP),
402c569e805SSumeet Pawnikar 		.driver_data = board_cnl, },
40335709c4eSGayatri Kammela 	{ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCH_THERMAL_DID_CML_H),
40435709c4eSGayatri Kammela 		.driver_data = board_cml, },
405e78acf7eSAndres Freund 	{ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCH_THERMAL_DID_LWB),
406e78acf7eSAndres Freund 		.driver_data = board_lwb, },
40740dc1929STim Zimmermann 	{ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCH_THERMAL_DID_WBG),
40840dc1929STim Zimmermann 		.driver_data = board_wbg, },
4093e8c4d31SAmit Kucheria 	{ 0, },
4103e8c4d31SAmit Kucheria };
4113e8c4d31SAmit Kucheria MODULE_DEVICE_TABLE(pci, intel_pch_thermal_id);
4123e8c4d31SAmit Kucheria 
4133e8c4d31SAmit Kucheria static const struct dev_pm_ops intel_pch_pm_ops = {
41428708e19SZhang Rui 	.suspend_noirq = intel_pch_thermal_suspend_noirq,
4153e8c4d31SAmit Kucheria 	.resume = intel_pch_thermal_resume,
4163e8c4d31SAmit Kucheria };
4173e8c4d31SAmit Kucheria 
4183e8c4d31SAmit Kucheria static struct pci_driver intel_pch_thermal_driver = {
4193e8c4d31SAmit Kucheria 	.name		= "intel_pch_thermal",
4203e8c4d31SAmit Kucheria 	.id_table	= intel_pch_thermal_id,
4213e8c4d31SAmit Kucheria 	.probe		= intel_pch_thermal_probe,
4223e8c4d31SAmit Kucheria 	.remove		= intel_pch_thermal_remove,
4233e8c4d31SAmit Kucheria 	.driver.pm	= &intel_pch_pm_ops,
4243e8c4d31SAmit Kucheria };
4253e8c4d31SAmit Kucheria 
4263e8c4d31SAmit Kucheria module_pci_driver(intel_pch_thermal_driver);
4273e8c4d31SAmit Kucheria 
4283e8c4d31SAmit Kucheria MODULE_LICENSE("GPL v2");
4293e8c4d31SAmit Kucheria MODULE_DESCRIPTION("Intel PCH Thermal driver");
430