|
| 1 | +/* intel_pch_thermal.c - Intel PCH Thermal driver |
| 2 | + * |
| 3 | + * Copyright (c) 2015, Intel Corporation. |
| 4 | + * |
| 5 | + * Authors: |
| 6 | + * Tushar Dave <tushar.n.dave@intel.com> |
| 7 | + * |
| 8 | + * This program is free software; you can redistribute it and/or modify it |
| 9 | + * under the terms and conditions of the GNU General Public License, |
| 10 | + * version 2, as published by the Free Software Foundation. |
| 11 | + * |
| 12 | + * This program is distributed in the hope it will be useful, but WITHOUT |
| 13 | + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or |
| 14 | + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for |
| 15 | + * more details. |
| 16 | + * |
| 17 | + */ |
| 18 | + |
| 19 | +#include <linux/module.h> |
| 20 | +#include <linux/types.h> |
| 21 | +#include <linux/init.h> |
| 22 | +#include <linux/pci.h> |
| 23 | +#include <linux/thermal.h> |
| 24 | + |
| 25 | +/* Intel PCH thermal Device IDs */ |
| 26 | +#define PCH_THERMAL_DID_WPT 0x9CA4 /* Wildcat Point */ |
| 27 | + |
| 28 | +/* Wildcat Point-LP PCH Thermal registers */ |
| 29 | +#define WPT_TEMP 0x0000 /* Temperature */ |
| 30 | +#define WPT_TSC 0x04 /* Thermal Sensor Control */ |
| 31 | +#define WPT_TSS 0x06 /* Thermal Sensor Status */ |
| 32 | +#define WPT_TSEL 0x08 /* Thermal Sensor Enable and Lock */ |
| 33 | +#define WPT_TSREL 0x0A /* Thermal Sensor Report Enable and Lock */ |
| 34 | +#define WPT_TSMIC 0x0C /* Thermal Sensor SMI Control */ |
| 35 | +#define WPT_CTT 0x0010 /* Catastrophic Trip Point */ |
| 36 | +#define WPT_TAHV 0x0014 /* Thermal Alert High Value */ |
| 37 | +#define WPT_TALV 0x0018 /* Thermal Alert Low Value */ |
| 38 | +#define WPT_TL 0x00000040 /* Throttle Value */ |
| 39 | +#define WPT_PHL 0x0060 /* PCH Hot Level */ |
| 40 | +#define WPT_PHLC 0x62 /* PHL Control */ |
| 41 | +#define WPT_TAS 0x80 /* Thermal Alert Status */ |
| 42 | +#define WPT_TSPIEN 0x82 /* PCI Interrupt Event Enables */ |
| 43 | +#define WPT_TSGPEN 0x84 /* General Purpose Event Enables */ |
| 44 | + |
| 45 | +/* Wildcat Point-LP PCH Thermal Register bit definitions */ |
| 46 | +#define WPT_TEMP_TSR 0x00ff /* Temp TS Reading */ |
| 47 | +#define WPT_TSC_CPDE 0x01 /* Catastrophic Power-Down Enable */ |
| 48 | +#define WPT_TSS_TSDSS 0x10 /* Thermal Sensor Dynamic Shutdown Status */ |
| 49 | +#define WPT_TSS_GPES 0x08 /* GPE status */ |
| 50 | +#define WPT_TSEL_ETS 0x01 /* Enable TS */ |
| 51 | +#define WPT_TSEL_PLDB 0x80 /* TSEL Policy Lock-Down Bit */ |
| 52 | +#define WPT_TL_TOL 0x000001FF /* T0 Level */ |
| 53 | +#define WPT_TL_T1L 0x1ff00000 /* T1 Level */ |
| 54 | +#define WPT_TL_TTEN 0x20000000 /* TT Enable */ |
| 55 | + |
| 56 | +static char driver_name[] = "Intel PCH thermal driver"; |
| 57 | + |
| 58 | +struct pch_thermal_device { |
| 59 | + void __iomem *hw_base; |
| 60 | + const struct pch_dev_ops *ops; |
| 61 | + struct pci_dev *pdev; |
| 62 | + struct thermal_zone_device *tzd; |
| 63 | + int crt_trip_id; |
| 64 | + unsigned long crt_temp; |
| 65 | + int hot_trip_id; |
| 66 | + unsigned long hot_temp; |
| 67 | +}; |
| 68 | + |
| 69 | +static int pch_wpt_init(struct pch_thermal_device *ptd, int *nr_trips) |
| 70 | +{ |
| 71 | + u8 tsel; |
| 72 | + u16 trip_temp; |
| 73 | + |
| 74 | + *nr_trips = 0; |
| 75 | + |
| 76 | + /* Check if BIOS has already enabled thermal sensor */ |
| 77 | + if (WPT_TSS_TSDSS & readb(ptd->hw_base + WPT_TSS)) |
| 78 | + goto read_trips; |
| 79 | + |
| 80 | + tsel = readb(ptd->hw_base + WPT_TSEL); |
| 81 | + /* |
| 82 | + * When TSEL's Policy Lock-Down bit is 1, TSEL become RO. |
| 83 | + * If so, thermal sensor cannot enable. Bail out. |
| 84 | + */ |
| 85 | + if (tsel & WPT_TSEL_PLDB) { |
| 86 | + dev_err(&ptd->pdev->dev, "Sensor can't be enabled\n"); |
| 87 | + return -ENODEV; |
| 88 | + } |
| 89 | + |
| 90 | + writeb(tsel|WPT_TSEL_ETS, ptd->hw_base + WPT_TSEL); |
| 91 | + if (!(WPT_TSS_TSDSS & readb(ptd->hw_base + WPT_TSS))) { |
| 92 | + dev_err(&ptd->pdev->dev, "Sensor can't be enabled\n"); |
| 93 | + return -ENODEV; |
| 94 | + } |
| 95 | + |
| 96 | +read_trips: |
| 97 | + ptd->crt_trip_id = -1; |
| 98 | + trip_temp = readw(ptd->hw_base + WPT_CTT); |
| 99 | + trip_temp &= 0x1FF; |
| 100 | + if (trip_temp) { |
| 101 | + /* Resolution of 1/2 degree C and an offset of -50C */ |
| 102 | + ptd->crt_temp = trip_temp * 1000 / 2 - 50000; |
| 103 | + ptd->crt_trip_id = 0; |
| 104 | + ++(*nr_trips); |
| 105 | + } |
| 106 | + |
| 107 | + ptd->hot_trip_id = -1; |
| 108 | + trip_temp = readw(ptd->hw_base + WPT_PHL); |
| 109 | + trip_temp &= 0x1FF; |
| 110 | + if (trip_temp) { |
| 111 | + /* Resolution of 1/2 degree C and an offset of -50C */ |
| 112 | + ptd->hot_temp = trip_temp * 1000 / 2 - 50000; |
| 113 | + ptd->hot_trip_id = *nr_trips; |
| 114 | + ++(*nr_trips); |
| 115 | + } |
| 116 | + |
| 117 | + return 0; |
| 118 | +} |
| 119 | + |
| 120 | +static int pch_wpt_get_temp(struct pch_thermal_device *ptd, |
| 121 | + unsigned long *temp) |
| 122 | +{ |
| 123 | + u8 wpt_temp; |
| 124 | + |
| 125 | + wpt_temp = WPT_TEMP_TSR & readl(ptd->hw_base + WPT_TEMP); |
| 126 | + |
| 127 | + /* Resolution of 1/2 degree C and an offset of -50C */ |
| 128 | + *temp = (wpt_temp * 1000 / 2 - 50000); |
| 129 | + |
| 130 | + return 0; |
| 131 | +} |
| 132 | + |
| 133 | +struct pch_dev_ops { |
| 134 | + int (*hw_init)(struct pch_thermal_device *ptd, int *nr_trips); |
| 135 | + int (*get_temp)(struct pch_thermal_device *ptd, unsigned long *temp); |
| 136 | +}; |
| 137 | + |
| 138 | + |
| 139 | +/* dev ops for Wildcat Point */ |
| 140 | +static struct pch_dev_ops pch_dev_ops_wpt = { |
| 141 | + .hw_init = pch_wpt_init, |
| 142 | + .get_temp = pch_wpt_get_temp, |
| 143 | +}; |
| 144 | + |
| 145 | +static int pch_thermal_get_temp(struct thermal_zone_device *tzd, |
| 146 | + unsigned long *temp) |
| 147 | +{ |
| 148 | + struct pch_thermal_device *ptd = tzd->devdata; |
| 149 | + |
| 150 | + return ptd->ops->get_temp(ptd, temp); |
| 151 | +} |
| 152 | + |
| 153 | +static int pch_get_trip_type(struct thermal_zone_device *tzd, int trip, |
| 154 | + enum thermal_trip_type *type) |
| 155 | +{ |
| 156 | + struct pch_thermal_device *ptd = tzd->devdata; |
| 157 | + |
| 158 | + if (ptd->crt_trip_id == trip) |
| 159 | + *type = THERMAL_TRIP_CRITICAL; |
| 160 | + else if (ptd->hot_trip_id == trip) |
| 161 | + *type = THERMAL_TRIP_HOT; |
| 162 | + else |
| 163 | + return -EINVAL; |
| 164 | + |
| 165 | + return 0; |
| 166 | +} |
| 167 | + |
| 168 | +static int pch_get_trip_temp(struct thermal_zone_device *tzd, int trip, |
| 169 | + unsigned long *temp) |
| 170 | +{ |
| 171 | + struct pch_thermal_device *ptd = tzd->devdata; |
| 172 | + |
| 173 | + if (ptd->crt_trip_id == trip) |
| 174 | + *temp = ptd->crt_temp; |
| 175 | + else if (ptd->hot_trip_id == trip) |
| 176 | + *temp = ptd->hot_temp; |
| 177 | + else |
| 178 | + return -EINVAL; |
| 179 | + |
| 180 | + return 0; |
| 181 | +} |
| 182 | + |
| 183 | +static struct thermal_zone_device_ops tzd_ops = { |
| 184 | + .get_temp = pch_thermal_get_temp, |
| 185 | + .get_trip_type = pch_get_trip_type, |
| 186 | + .get_trip_temp = pch_get_trip_temp, |
| 187 | +}; |
| 188 | + |
| 189 | + |
| 190 | +static int intel_pch_thermal_probe(struct pci_dev *pdev, |
| 191 | + const struct pci_device_id *id) |
| 192 | +{ |
| 193 | + struct pch_thermal_device *ptd; |
| 194 | + int err; |
| 195 | + int nr_trips; |
| 196 | + char *dev_name; |
| 197 | + |
| 198 | + ptd = devm_kzalloc(&pdev->dev, sizeof(*ptd), GFP_KERNEL); |
| 199 | + if (!ptd) |
| 200 | + return -ENOMEM; |
| 201 | + |
| 202 | + switch (pdev->device) { |
| 203 | + case PCH_THERMAL_DID_WPT: |
| 204 | + ptd->ops = &pch_dev_ops_wpt; |
| 205 | + dev_name = "pch_wildcat_point"; |
| 206 | + break; |
| 207 | + default: |
| 208 | + dev_err(&pdev->dev, "unknown pch thermal device\n"); |
| 209 | + return -ENODEV; |
| 210 | + } |
| 211 | + |
| 212 | + pci_set_drvdata(pdev, ptd); |
| 213 | + ptd->pdev = pdev; |
| 214 | + |
| 215 | + err = pci_enable_device(pdev); |
| 216 | + if (err) { |
| 217 | + dev_err(&pdev->dev, "failed to enable pci device\n"); |
| 218 | + return err; |
| 219 | + } |
| 220 | + |
| 221 | + err = pci_request_regions(pdev, driver_name); |
| 222 | + if (err) { |
| 223 | + dev_err(&pdev->dev, "failed to request pci region\n"); |
| 224 | + goto error_disable; |
| 225 | + } |
| 226 | + |
| 227 | + ptd->hw_base = pci_ioremap_bar(pdev, 0); |
| 228 | + if (!ptd->hw_base) { |
| 229 | + err = -ENOMEM; |
| 230 | + dev_err(&pdev->dev, "failed to map mem base\n"); |
| 231 | + goto error_release; |
| 232 | + } |
| 233 | + |
| 234 | + err = ptd->ops->hw_init(ptd, &nr_trips); |
| 235 | + if (err) |
| 236 | + goto error_cleanup; |
| 237 | + |
| 238 | + ptd->tzd = thermal_zone_device_register(dev_name, nr_trips, 0, ptd, |
| 239 | + &tzd_ops, NULL, 0, 0); |
| 240 | + if (IS_ERR(ptd->tzd)) { |
| 241 | + dev_err(&pdev->dev, "Failed to register thermal zone %s\n", |
| 242 | + dev_name); |
| 243 | + err = PTR_ERR(ptd->tzd); |
| 244 | + goto error_cleanup; |
| 245 | + } |
| 246 | + |
| 247 | + return 0; |
| 248 | + |
| 249 | +error_cleanup: |
| 250 | + iounmap(ptd->hw_base); |
| 251 | +error_release: |
| 252 | + pci_release_regions(pdev); |
| 253 | +error_disable: |
| 254 | + pci_disable_device(pdev); |
| 255 | + dev_err(&pdev->dev, "pci device failed to probe\n"); |
| 256 | + return err; |
| 257 | +} |
| 258 | + |
| 259 | +static void intel_pch_thermal_remove(struct pci_dev *pdev) |
| 260 | +{ |
| 261 | + struct pch_thermal_device *ptd = pci_get_drvdata(pdev); |
| 262 | + |
| 263 | + thermal_zone_device_unregister(ptd->tzd); |
| 264 | + iounmap(ptd->hw_base); |
| 265 | + pci_set_drvdata(pdev, NULL); |
| 266 | + pci_release_region(pdev, 0); |
| 267 | + pci_disable_device(pdev); |
| 268 | +} |
| 269 | + |
| 270 | +static struct pci_device_id intel_pch_thermal_id[] = { |
| 271 | + { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCH_THERMAL_DID_WPT) }, |
| 272 | + { 0, }, |
| 273 | +}; |
| 274 | +MODULE_DEVICE_TABLE(pci, intel_pch_thermal_id); |
| 275 | + |
| 276 | +static struct pci_driver intel_pch_thermal_driver = { |
| 277 | + .name = "intel_pch_thermal", |
| 278 | + .id_table = intel_pch_thermal_id, |
| 279 | + .probe = intel_pch_thermal_probe, |
| 280 | + .remove = intel_pch_thermal_remove, |
| 281 | +}; |
| 282 | + |
| 283 | +module_pci_driver(intel_pch_thermal_driver); |
| 284 | + |
| 285 | +MODULE_LICENSE("GPL v2"); |
| 286 | +MODULE_DESCRIPTION("Intel PCH Thermal driver"); |
0 commit comments