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 1201aa4f925SRafael J. Wysocki static int pch_hw_init(struct pch_thermal_device *ptd) 1213e8c4d31SAmit Kucheria { 122558718f4SRafael J. Wysocki int nr_trips = 0; 1233e8c4d31SAmit Kucheria u16 trip_temp; 124558718f4SRafael J. Wysocki u8 tsel; 1253e8c4d31SAmit Kucheria 1263e8c4d31SAmit Kucheria /* Check if BIOS has already enabled thermal sensor */ 1273e8c4d31SAmit Kucheria if (WPT_TSEL_ETS & readb(ptd->hw_base + WPT_TSEL)) { 1283e8c4d31SAmit Kucheria ptd->bios_enabled = true; 1293e8c4d31SAmit Kucheria goto read_trips; 1303e8c4d31SAmit Kucheria } 1313e8c4d31SAmit Kucheria 1323e8c4d31SAmit Kucheria tsel = readb(ptd->hw_base + WPT_TSEL); 1333e8c4d31SAmit Kucheria /* 1343e8c4d31SAmit Kucheria * When TSEL's Policy Lock-Down bit is 1, TSEL become RO. 1353e8c4d31SAmit Kucheria * If so, thermal sensor cannot enable. Bail out. 1363e8c4d31SAmit Kucheria */ 1373e8c4d31SAmit Kucheria if (tsel & WPT_TSEL_PLDB) { 1383e8c4d31SAmit Kucheria dev_err(&ptd->pdev->dev, "Sensor can't be enabled\n"); 1393e8c4d31SAmit Kucheria return -ENODEV; 1403e8c4d31SAmit Kucheria } 1413e8c4d31SAmit Kucheria 1423e8c4d31SAmit Kucheria writeb(tsel|WPT_TSEL_ETS, ptd->hw_base + WPT_TSEL); 1433e8c4d31SAmit Kucheria if (!(WPT_TSEL_ETS & readb(ptd->hw_base + WPT_TSEL))) { 1443e8c4d31SAmit Kucheria dev_err(&ptd->pdev->dev, "Sensor can't be enabled\n"); 1453e8c4d31SAmit Kucheria return -ENODEV; 1463e8c4d31SAmit Kucheria } 1473e8c4d31SAmit Kucheria 1483e8c4d31SAmit Kucheria read_trips: 1493e8c4d31SAmit Kucheria trip_temp = readw(ptd->hw_base + WPT_CTT); 1503e8c4d31SAmit Kucheria trip_temp &= 0x1FF; 1513e8c4d31SAmit Kucheria if (trip_temp) { 152558718f4SRafael J. Wysocki ptd->trips[nr_trips].temperature = GET_WPT_TEMP(trip_temp); 153558718f4SRafael J. Wysocki ptd->trips[nr_trips++].type = THERMAL_TRIP_CRITICAL; 1543e8c4d31SAmit Kucheria } 1553e8c4d31SAmit Kucheria 1563e8c4d31SAmit Kucheria trip_temp = readw(ptd->hw_base + WPT_PHL); 1573e8c4d31SAmit Kucheria trip_temp &= 0x1FF; 1583e8c4d31SAmit Kucheria if (trip_temp) { 159558718f4SRafael J. Wysocki ptd->trips[nr_trips].temperature = GET_WPT_TEMP(trip_temp); 160558718f4SRafael J. Wysocki ptd->trips[nr_trips++].type = THERMAL_TRIP_HOT; 1613e8c4d31SAmit Kucheria } 1623e8c4d31SAmit Kucheria 163558718f4SRafael J. Wysocki return nr_trips + pch_wpt_add_acpi_psv_trip(ptd, nr_trips); 1643e8c4d31SAmit Kucheria } 1653e8c4d31SAmit Kucheria 1661aa4f925SRafael J. Wysocki static int pch_get_temp(struct pch_thermal_device *ptd) 1673e8c4d31SAmit Kucheria { 168558718f4SRafael J. Wysocki return GET_WPT_TEMP(WPT_TEMP_TSR & readw(ptd->hw_base + WPT_TEMP)); 1693e8c4d31SAmit Kucheria } 1703e8c4d31SAmit Kucheria 17128708e19SZhang Rui /* Cool the PCH when it's overheat in .suspend_noirq phase */ 1721aa4f925SRafael J. Wysocki static int pch_suspend(struct pch_thermal_device *ptd) 1733e8c4d31SAmit Kucheria { 1743e8c4d31SAmit Kucheria u8 tsel; 175bd30d075SZhang Rui int pch_delay_cnt = 0; 176ef63b043SSumeet Pawnikar u16 pch_thr_temp, pch_cur_temp; 1773e8c4d31SAmit Kucheria 178ef63b043SSumeet Pawnikar /* Shutdown the thermal sensor if it is not enabled by BIOS */ 179ef63b043SSumeet Pawnikar if (!ptd->bios_enabled) { 180ef63b043SSumeet Pawnikar tsel = readb(ptd->hw_base + WPT_TSEL); 181ef63b043SSumeet Pawnikar writeb(tsel & 0xFE, ptd->hw_base + WPT_TSEL); 182ef63b043SSumeet Pawnikar return 0; 183ef63b043SSumeet Pawnikar } 184ef63b043SSumeet Pawnikar 185ef63b043SSumeet Pawnikar /* Do not check temperature if it is not s2idle */ 186ef63b043SSumeet Pawnikar if (pm_suspend_via_firmware()) 187ef63b043SSumeet Pawnikar return 0; 1883e8c4d31SAmit Kucheria 189ef63b043SSumeet Pawnikar /* Get the PCH temperature threshold value */ 190ef63b043SSumeet Pawnikar pch_thr_temp = GET_PCH_TEMP(WPT_TEMP_TSR & readw(ptd->hw_base + WPT_TSPM)); 191ef63b043SSumeet Pawnikar 192ef63b043SSumeet Pawnikar /* Get the PCH current temperature value */ 193ef63b043SSumeet Pawnikar pch_cur_temp = GET_PCH_TEMP(WPT_TEMP_TSR & readw(ptd->hw_base + WPT_TEMP)); 194ef63b043SSumeet Pawnikar 195ef63b043SSumeet Pawnikar /* 196ef63b043SSumeet Pawnikar * If current PCH temperature is higher than configured PCH threshold 197ef63b043SSumeet Pawnikar * value, run some delay loop with sleep to let the current temperature 198ef63b043SSumeet Pawnikar * go down below the threshold value which helps to allow system enter 199ef63b043SSumeet Pawnikar * lower power S0ix suspend state. Even after delay loop if PCH current 200ef63b043SSumeet Pawnikar * temperature stays above threshold, notify the warning message 201ef63b043SSumeet Pawnikar * which helps to indentify the reason why S0ix entry was rejected. 202ef63b043SSumeet Pawnikar */ 203bd30d075SZhang Rui while (pch_delay_cnt < delay_cnt) { 20492923028SZhang Rui if (pch_cur_temp < pch_thr_temp) 20592923028SZhang Rui break; 20692923028SZhang Rui 207bd30d075SZhang Rui if (pm_wakeup_pending()) { 208bd30d075SZhang Rui dev_warn(&ptd->pdev->dev, "Wakeup event detected, abort cooling\n"); 209bd30d075SZhang Rui return 0; 210bd30d075SZhang Rui } 211ef63b043SSumeet Pawnikar 212bd30d075SZhang Rui pch_delay_cnt++; 213bd30d075SZhang Rui dev_dbg(&ptd->pdev->dev, 214ef63b043SSumeet Pawnikar "CPU-PCH current temp [%dC] higher than the threshold temp [%dC], sleep %d times for %d ms duration\n", 215ef63b043SSumeet Pawnikar pch_cur_temp, pch_thr_temp, pch_delay_cnt, delay_timeout); 216ef63b043SSumeet Pawnikar msleep(delay_timeout); 217ef63b043SSumeet Pawnikar /* Read the PCH current temperature for next cycle. */ 218ef63b043SSumeet Pawnikar pch_cur_temp = GET_PCH_TEMP(WPT_TEMP_TSR & readw(ptd->hw_base + WPT_TEMP)); 219ef63b043SSumeet Pawnikar } 220ef63b043SSumeet Pawnikar 22192923028SZhang Rui if (pch_cur_temp >= pch_thr_temp) 222ef63b043SSumeet Pawnikar dev_warn(&ptd->pdev->dev, 223bd30d075SZhang Rui "CPU-PCH is hot [%dC] after %d ms delay. S0ix might fail\n", 224bd30d075SZhang Rui pch_cur_temp, pch_delay_cnt * delay_timeout); 225bd30d075SZhang Rui else { 226bd30d075SZhang Rui if (pch_delay_cnt) 227bd30d075SZhang Rui dev_info(&ptd->pdev->dev, 228bd30d075SZhang Rui "CPU-PCH is cool [%dC] after %d ms delay\n", 229bd30d075SZhang Rui pch_cur_temp, pch_delay_cnt * delay_timeout); 230ef63b043SSumeet Pawnikar else 231ef63b043SSumeet Pawnikar dev_info(&ptd->pdev->dev, 232bd30d075SZhang Rui "CPU-PCH is cool [%dC]\n", 233bd30d075SZhang Rui pch_cur_temp); 234bd30d075SZhang Rui } 2353e8c4d31SAmit Kucheria 2363e8c4d31SAmit Kucheria return 0; 2373e8c4d31SAmit Kucheria } 2383e8c4d31SAmit Kucheria 2391aa4f925SRafael J. Wysocki static int pch_resume(struct pch_thermal_device *ptd) 2403e8c4d31SAmit Kucheria { 2413e8c4d31SAmit Kucheria u8 tsel; 2423e8c4d31SAmit Kucheria 2433e8c4d31SAmit Kucheria if (ptd->bios_enabled) 2443e8c4d31SAmit Kucheria return 0; 2453e8c4d31SAmit Kucheria 2463e8c4d31SAmit Kucheria tsel = readb(ptd->hw_base + WPT_TSEL); 2473e8c4d31SAmit Kucheria 2483e8c4d31SAmit Kucheria writeb(tsel | WPT_TSEL_ETS, ptd->hw_base + WPT_TSEL); 2493e8c4d31SAmit Kucheria 2503e8c4d31SAmit Kucheria return 0; 2513e8c4d31SAmit Kucheria } 2523e8c4d31SAmit Kucheria 2533e8c4d31SAmit Kucheria static int pch_thermal_get_temp(struct thermal_zone_device *tzd, int *temp) 2543e8c4d31SAmit Kucheria { 2553e8c4d31SAmit Kucheria struct pch_thermal_device *ptd = tzd->devdata; 2563e8c4d31SAmit Kucheria 257*86cb1004SRafael J. Wysocki *temp = pch_get_temp(ptd); 258558718f4SRafael J. Wysocki return 0; 2593e8c4d31SAmit Kucheria } 2603e8c4d31SAmit Kucheria 26103671968SKai-Heng Feng static void pch_critical(struct thermal_zone_device *tzd) 26203671968SKai-Heng Feng { 26303671968SKai-Heng Feng dev_dbg(&tzd->device, "%s: critical temperature reached\n", tzd->type); 26403671968SKai-Heng Feng } 26503671968SKai-Heng Feng 2663e8c4d31SAmit Kucheria static struct thermal_zone_device_ops tzd_ops = { 2673e8c4d31SAmit Kucheria .get_temp = pch_thermal_get_temp, 26803671968SKai-Heng Feng .critical = pch_critical, 2693e8c4d31SAmit Kucheria }; 2703e8c4d31SAmit Kucheria 2713e8c4d31SAmit Kucheria enum board_ids { 2723e8c4d31SAmit Kucheria board_hsw, 2733e8c4d31SAmit Kucheria board_wpt, 2743e8c4d31SAmit Kucheria board_skl, 2753e8c4d31SAmit Kucheria board_cnl, 27635709c4eSGayatri Kammela board_cml, 277e78acf7eSAndres Freund board_lwb, 27840dc1929STim Zimmermann board_wbg, 2793e8c4d31SAmit Kucheria }; 2803e8c4d31SAmit Kucheria 2813e8c4d31SAmit Kucheria static const struct board_info { 2823e8c4d31SAmit Kucheria const char *name; 2833e8c4d31SAmit Kucheria } board_info[] = { 2843e8c4d31SAmit Kucheria [board_hsw] = { 2853e8c4d31SAmit Kucheria .name = "pch_haswell", 2863e8c4d31SAmit Kucheria }, 2873e8c4d31SAmit Kucheria [board_wpt] = { 2883e8c4d31SAmit Kucheria .name = "pch_wildcat_point", 2893e8c4d31SAmit Kucheria }, 2903e8c4d31SAmit Kucheria [board_skl] = { 2913e8c4d31SAmit Kucheria .name = "pch_skylake", 2923e8c4d31SAmit Kucheria }, 2933e8c4d31SAmit Kucheria [board_cnl] = { 2943e8c4d31SAmit Kucheria .name = "pch_cannonlake", 2953e8c4d31SAmit Kucheria }, 29635709c4eSGayatri Kammela [board_cml] = { 29735709c4eSGayatri Kammela .name = "pch_cometlake", 298e78acf7eSAndres Freund }, 299e78acf7eSAndres Freund [board_lwb] = { 300e78acf7eSAndres Freund .name = "pch_lewisburg", 301e78acf7eSAndres Freund }, 30240dc1929STim Zimmermann [board_wbg] = { 30340dc1929STim Zimmermann .name = "pch_wellsburg", 30440dc1929STim Zimmermann }, 3053e8c4d31SAmit Kucheria }; 3063e8c4d31SAmit Kucheria 3073e8c4d31SAmit Kucheria static int intel_pch_thermal_probe(struct pci_dev *pdev, 3083e8c4d31SAmit Kucheria const struct pci_device_id *id) 3093e8c4d31SAmit Kucheria { 3103e8c4d31SAmit Kucheria enum board_ids board_id = id->driver_data; 3113e8c4d31SAmit Kucheria const struct board_info *bi = &board_info[board_id]; 3123e8c4d31SAmit Kucheria struct pch_thermal_device *ptd; 3133e8c4d31SAmit Kucheria int err; 3143e8c4d31SAmit Kucheria int nr_trips; 3153e8c4d31SAmit Kucheria 3163e8c4d31SAmit Kucheria ptd = devm_kzalloc(&pdev->dev, sizeof(*ptd), GFP_KERNEL); 3173e8c4d31SAmit Kucheria if (!ptd) 3183e8c4d31SAmit Kucheria return -ENOMEM; 3193e8c4d31SAmit Kucheria 3203e8c4d31SAmit Kucheria pci_set_drvdata(pdev, ptd); 3213e8c4d31SAmit Kucheria ptd->pdev = pdev; 3223e8c4d31SAmit Kucheria 3233e8c4d31SAmit Kucheria err = pci_enable_device(pdev); 3243e8c4d31SAmit Kucheria if (err) { 3253e8c4d31SAmit Kucheria dev_err(&pdev->dev, "failed to enable pci device\n"); 3263e8c4d31SAmit Kucheria return err; 3273e8c4d31SAmit Kucheria } 3283e8c4d31SAmit Kucheria 3293e8c4d31SAmit Kucheria err = pci_request_regions(pdev, driver_name); 3303e8c4d31SAmit Kucheria if (err) { 3313e8c4d31SAmit Kucheria dev_err(&pdev->dev, "failed to request pci region\n"); 3323e8c4d31SAmit Kucheria goto error_disable; 3333e8c4d31SAmit Kucheria } 3343e8c4d31SAmit Kucheria 3353e8c4d31SAmit Kucheria ptd->hw_base = pci_ioremap_bar(pdev, 0); 3363e8c4d31SAmit Kucheria if (!ptd->hw_base) { 3373e8c4d31SAmit Kucheria err = -ENOMEM; 3383e8c4d31SAmit Kucheria dev_err(&pdev->dev, "failed to map mem base\n"); 3393e8c4d31SAmit Kucheria goto error_release; 3403e8c4d31SAmit Kucheria } 3413e8c4d31SAmit Kucheria 342*86cb1004SRafael J. Wysocki nr_trips = pch_hw_init(ptd); 343558718f4SRafael J. Wysocki if (nr_trips < 0) { 344558718f4SRafael J. Wysocki err = nr_trips; 3453e8c4d31SAmit Kucheria goto error_cleanup; 346558718f4SRafael J. Wysocki } 3473e8c4d31SAmit Kucheria 348fee19c69SDaniel Lezcano ptd->tzd = thermal_zone_device_register_with_trips(bi->name, ptd->trips, 349fee19c69SDaniel Lezcano nr_trips, 0, ptd, 3503e8c4d31SAmit Kucheria &tzd_ops, NULL, 0, 0); 3513e8c4d31SAmit Kucheria if (IS_ERR(ptd->tzd)) { 3523e8c4d31SAmit Kucheria dev_err(&pdev->dev, "Failed to register thermal zone %s\n", 3533e8c4d31SAmit Kucheria bi->name); 3543e8c4d31SAmit Kucheria err = PTR_ERR(ptd->tzd); 3553e8c4d31SAmit Kucheria goto error_cleanup; 3563e8c4d31SAmit Kucheria } 357bbcf90c0SAndrzej Pietrasiewicz err = thermal_zone_device_enable(ptd->tzd); 358bbcf90c0SAndrzej Pietrasiewicz if (err) 359bbcf90c0SAndrzej Pietrasiewicz goto err_unregister; 3603e8c4d31SAmit Kucheria 3613e8c4d31SAmit Kucheria return 0; 3623e8c4d31SAmit Kucheria 363bbcf90c0SAndrzej Pietrasiewicz err_unregister: 364bbcf90c0SAndrzej Pietrasiewicz thermal_zone_device_unregister(ptd->tzd); 3653e8c4d31SAmit Kucheria error_cleanup: 3663e8c4d31SAmit Kucheria iounmap(ptd->hw_base); 3673e8c4d31SAmit Kucheria error_release: 3683e8c4d31SAmit Kucheria pci_release_regions(pdev); 3693e8c4d31SAmit Kucheria error_disable: 3703e8c4d31SAmit Kucheria pci_disable_device(pdev); 3713e8c4d31SAmit Kucheria dev_err(&pdev->dev, "pci device failed to probe\n"); 3723e8c4d31SAmit Kucheria return err; 3733e8c4d31SAmit Kucheria } 3743e8c4d31SAmit Kucheria 3753e8c4d31SAmit Kucheria static void intel_pch_thermal_remove(struct pci_dev *pdev) 3763e8c4d31SAmit Kucheria { 3773e8c4d31SAmit Kucheria struct pch_thermal_device *ptd = pci_get_drvdata(pdev); 3783e8c4d31SAmit Kucheria 3793e8c4d31SAmit Kucheria thermal_zone_device_unregister(ptd->tzd); 3803e8c4d31SAmit Kucheria iounmap(ptd->hw_base); 3813e8c4d31SAmit Kucheria pci_set_drvdata(pdev, NULL); 38266dd8b80SChuhong Yuan pci_release_regions(pdev); 3833e8c4d31SAmit Kucheria pci_disable_device(pdev); 3843e8c4d31SAmit Kucheria } 3853e8c4d31SAmit Kucheria 38628708e19SZhang Rui static int intel_pch_thermal_suspend_noirq(struct device *device) 3873e8c4d31SAmit Kucheria { 38897e9cafeSChuhong Yuan struct pch_thermal_device *ptd = dev_get_drvdata(device); 3893e8c4d31SAmit Kucheria 390*86cb1004SRafael J. Wysocki return pch_suspend(ptd); 3913e8c4d31SAmit Kucheria } 3923e8c4d31SAmit Kucheria 3933e8c4d31SAmit Kucheria static int intel_pch_thermal_resume(struct device *device) 3943e8c4d31SAmit Kucheria { 39597e9cafeSChuhong Yuan struct pch_thermal_device *ptd = dev_get_drvdata(device); 3963e8c4d31SAmit Kucheria 397*86cb1004SRafael J. Wysocki return pch_resume(ptd); 3983e8c4d31SAmit Kucheria } 3993e8c4d31SAmit Kucheria 4003e8c4d31SAmit Kucheria static const struct pci_device_id intel_pch_thermal_id[] = { 4013e8c4d31SAmit Kucheria { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCH_THERMAL_DID_HSW_1), 4023e8c4d31SAmit Kucheria .driver_data = board_hsw, }, 4033e8c4d31SAmit Kucheria { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCH_THERMAL_DID_HSW_2), 4043e8c4d31SAmit Kucheria .driver_data = board_hsw, }, 4053e8c4d31SAmit Kucheria { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCH_THERMAL_DID_WPT), 4063e8c4d31SAmit Kucheria .driver_data = board_wpt, }, 4073e8c4d31SAmit Kucheria { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCH_THERMAL_DID_SKL), 4083e8c4d31SAmit Kucheria .driver_data = board_skl, }, 4093e8c4d31SAmit Kucheria { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCH_THERMAL_DID_SKL_H), 4103e8c4d31SAmit Kucheria .driver_data = board_skl, }, 4113e8c4d31SAmit Kucheria { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCH_THERMAL_DID_CNL), 4123e8c4d31SAmit Kucheria .driver_data = board_cnl, }, 4133e8c4d31SAmit Kucheria { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCH_THERMAL_DID_CNL_H), 4143e8c4d31SAmit Kucheria .driver_data = board_cnl, }, 415c569e805SSumeet Pawnikar { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCH_THERMAL_DID_CNL_LP), 416c569e805SSumeet Pawnikar .driver_data = board_cnl, }, 41735709c4eSGayatri Kammela { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCH_THERMAL_DID_CML_H), 41835709c4eSGayatri Kammela .driver_data = board_cml, }, 419e78acf7eSAndres Freund { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCH_THERMAL_DID_LWB), 420e78acf7eSAndres Freund .driver_data = board_lwb, }, 42140dc1929STim Zimmermann { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCH_THERMAL_DID_WBG), 42240dc1929STim Zimmermann .driver_data = board_wbg, }, 4233e8c4d31SAmit Kucheria { 0, }, 4243e8c4d31SAmit Kucheria }; 4253e8c4d31SAmit Kucheria MODULE_DEVICE_TABLE(pci, intel_pch_thermal_id); 4263e8c4d31SAmit Kucheria 4273e8c4d31SAmit Kucheria static const struct dev_pm_ops intel_pch_pm_ops = { 42828708e19SZhang Rui .suspend_noirq = intel_pch_thermal_suspend_noirq, 4293e8c4d31SAmit Kucheria .resume = intel_pch_thermal_resume, 4303e8c4d31SAmit Kucheria }; 4313e8c4d31SAmit Kucheria 4323e8c4d31SAmit Kucheria static struct pci_driver intel_pch_thermal_driver = { 4333e8c4d31SAmit Kucheria .name = "intel_pch_thermal", 4343e8c4d31SAmit Kucheria .id_table = intel_pch_thermal_id, 4353e8c4d31SAmit Kucheria .probe = intel_pch_thermal_probe, 4363e8c4d31SAmit Kucheria .remove = intel_pch_thermal_remove, 4373e8c4d31SAmit Kucheria .driver.pm = &intel_pch_pm_ops, 4383e8c4d31SAmit Kucheria }; 4393e8c4d31SAmit Kucheria 4403e8c4d31SAmit Kucheria module_pci_driver(intel_pch_thermal_driver); 4413e8c4d31SAmit Kucheria 4423e8c4d31SAmit Kucheria MODULE_LICENSE("GPL v2"); 4433e8c4d31SAmit Kucheria MODULE_DESCRIPTION("Intel PCH Thermal driver"); 444