drivers/thermal/intel/int340x_thermal/processor_thermal_device.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * processor_thermal_device.c
   4  * Copyright (c) 2014, Intel Corporation.
   5  */
   6 #include <linux/acpi.h>
   7 #include <linux/kernel.h>
   8 #include <linux/module.h>
   9 #include <linux/pci.h>
  10 #include <linux/thermal.h>
  11 #include "int340x_thermal_zone.h"
  12 #include "processor_thermal_device.h"
  13 #include "../intel_soc_dts_iosf.h"
  14
  15 #define DRV_NAME "proc_thermal"
  16
  17 #define POWER_LIMIT_SHOW(index, suffix) \
  18 static ssize_t power_limit_##index##_##suffix##_show(struct device *dev, \
  19                                         struct device_attribute *attr, \
  20                                         char *buf) \
  21 { \
  22         struct proc_thermal_device *proc_dev = dev_get_drvdata(dev); \
  23         \
  24         return sprintf(buf, "%lu\n",\
  25         (unsigned long)proc_dev->power_limits[index].suffix * 1000); \
  26 }
  27
  28 POWER_LIMIT_SHOW(0, min_uw)
  29 POWER_LIMIT_SHOW(0, max_uw)
  30 POWER_LIMIT_SHOW(0, step_uw)
  31 POWER_LIMIT_SHOW(0, tmin_us)
  32 POWER_LIMIT_SHOW(0, tmax_us)
  33
  34 POWER_LIMIT_SHOW(1, min_uw)
  35 POWER_LIMIT_SHOW(1, max_uw)
  36 POWER_LIMIT_SHOW(1, step_uw)
  37 POWER_LIMIT_SHOW(1, tmin_us)
  38 POWER_LIMIT_SHOW(1, tmax_us)
  39
  40 static DEVICE_ATTR_RO(power_limit_0_min_uw);
  41 static DEVICE_ATTR_RO(power_limit_0_max_uw);
  42 static DEVICE_ATTR_RO(power_limit_0_step_uw);
  43 static DEVICE_ATTR_RO(power_limit_0_tmin_us);
  44 static DEVICE_ATTR_RO(power_limit_0_tmax_us);
  45
  46 static DEVICE_ATTR_RO(power_limit_1_min_uw);
  47 static DEVICE_ATTR_RO(power_limit_1_max_uw);
  48 static DEVICE_ATTR_RO(power_limit_1_step_uw);
  49 static DEVICE_ATTR_RO(power_limit_1_tmin_us);
  50 static DEVICE_ATTR_RO(power_limit_1_tmax_us);
  51
  52 static struct attribute *power_limit_attrs[] = {
  53         &dev_attr_power_limit_0_min_uw.attr,
  54         &dev_attr_power_limit_1_min_uw.attr,
  55         &dev_attr_power_limit_0_max_uw.attr,
  56         &dev_attr_power_limit_1_max_uw.attr,
  57         &dev_attr_power_limit_0_step_uw.attr,
  58         &dev_attr_power_limit_1_step_uw.attr,
  59         &dev_attr_power_limit_0_tmin_us.attr,
  60         &dev_attr_power_limit_1_tmin_us.attr,
  61         &dev_attr_power_limit_0_tmax_us.attr,
  62         &dev_attr_power_limit_1_tmax_us.attr,
  63         NULL
  64 };
  65
  66 static const struct attribute_group power_limit_attribute_group = {
  67         .attrs = power_limit_attrs,
  68         .name = "power_limits"
  69 };
  70
  71 static int tcc_get_offset(void)
  72 {
  73         u64 val;
  74         int err;
  75
  76         err = rdmsrl_safe(MSR_IA32_TEMPERATURE_TARGET, &val);
  77         if (err)
  78                 return err;
  79
  80         return (val >> 24) & 0x3f;
  81 }
  82
  83 static ssize_t tcc_offset_degree_celsius_show(struct device *dev,
  84                                               struct device_attribute *attr,
  85                                               char *buf)
  86 {
  87         int tcc;
  88
  89         tcc = tcc_get_offset();
  90         if (tcc < 0)
  91                 return tcc;
  92
  93         return sprintf(buf, "%d\n", tcc);
  94 }
  95
  96 static int tcc_offset_update(unsigned int tcc)
  97 {
  98         u64 val;
  99         int err;
 100
 101         if (tcc > 63)
 102                 return -EINVAL;
 103
 104         err = rdmsrl_safe(MSR_IA32_TEMPERATURE_TARGET, &val);
 105         if (err)
 106                 return err;
 107
 108         if (val & BIT(31))
 109                 return -EPERM;
 110
 111         val &= ~GENMASK_ULL(29, 24);
 112         val |= (tcc & 0x3f) << 24;
 113
 114         err = wrmsrl_safe(MSR_IA32_TEMPERATURE_TARGET, val);
 115         if (err)
 116                 return err;
 117
 118         return 0;
 119 }
 120
 121 static ssize_t tcc_offset_degree_celsius_store(struct device *dev,
 122                                 struct device_attribute *attr, const char *buf,
 123                                 size_t count)
 124 {
 125         unsigned int tcc;
 126         u64 val;
 127         int err;
 128
 129         err = rdmsrl_safe(MSR_PLATFORM_INFO, &val);
 130         if (err)
 131                 return err;
 132
 133         if (!(val & BIT(30)))
 134                 return -EACCES;
 135
 136         if (kstrtouint(buf, 0, &tcc))
 137                 return -EINVAL;
 138
 139         err = tcc_offset_update(tcc);
 140         if (err)
 141                 return err;
 142
 143         return count;
 144 }
 145
 146 static DEVICE_ATTR_RW(tcc_offset_degree_celsius);
 147
 148 static int stored_tjmax; /* since it is fixed, we can have local storage */
 149
 150 static int get_tjmax(void)
 151 {
 152         u32 eax, edx;
 153         u32 val;
 154         int err;
 155
 156         err = rdmsr_safe(MSR_IA32_TEMPERATURE_TARGET, &eax, &edx);
 157         if (err)
 158                 return err;
 159
 160         val = (eax >> 16) & 0xff;
 161         if (val)
 162                 return val;
 163
 164         return -EINVAL;
 165 }
 166
 167 static int read_temp_msr(int *temp)
 168 {
 169         int cpu;
 170         u32 eax, edx;
 171         int err;
 172         unsigned long curr_temp_off = 0;
 173
 174         *temp = 0;
 175
 176         for_each_online_cpu(cpu) {
 177                 err = rdmsr_safe_on_cpu(cpu, MSR_IA32_THERM_STATUS, &eax,
 178                                         &edx);
 179                 if (err)
 180                         goto err_ret;
 181                 else {
 182                         if (eax & 0x80000000) {
 183                                 curr_temp_off = (eax >> 16) & 0x7f;
 184                                 if (!*temp || curr_temp_off < *temp)
 185                                         *temp = curr_temp_off;
 186                         } else {
 187                                 err = -EINVAL;
 188                                 goto err_ret;
 189                         }
 190                 }
 191         }
 192
 193         return 0;
 194 err_ret:
 195         return err;
 196 }
 197
 198 static int proc_thermal_get_zone_temp(struct thermal_zone_device *zone,
 199                                          int *temp)
 200 {
 201         int ret;
 202
 203         ret = read_temp_msr(temp);
 204         if (!ret)
 205                 *temp = (stored_tjmax - *temp) * 1000;
 206
 207         return ret;
 208 }
 209
 210 static struct thermal_zone_device_ops proc_thermal_local_ops = {
 211         .get_temp       = proc_thermal_get_zone_temp,
 212 };
 213
 214 static int proc_thermal_read_ppcc(struct proc_thermal_device *proc_priv)
 215 {
 216         int i;
 217         acpi_status status;
 218         struct acpi_buffer buf = { ACPI_ALLOCATE_BUFFER, NULL };
 219         union acpi_object *elements, *ppcc;
 220         union acpi_object *p;
 221         int ret = 0;
 222
 223         status = acpi_evaluate_object(proc_priv->adev->handle, "PPCC",
 224                                       NULL, &buf);
 225         if (ACPI_FAILURE(status))
 226                 return -ENODEV;
 227
 228         p = buf.pointer;
 229         if (!p || (p->type != ACPI_TYPE_PACKAGE)) {
 230                 dev_err(proc_priv->dev, "Invalid PPCC data\n");
 231                 ret = -EFAULT;
 232                 goto free_buffer;
 233         }
 234
 235         if (!p->package.count) {
 236                 dev_err(proc_priv->dev, "Invalid PPCC package size\n");
 237                 ret = -EFAULT;
 238                 goto free_buffer;
 239         }
 240
 241         for (i = 0; i < min((int)p->package.count - 1, 2); ++i) {
 242                 elements = &(p->package.elements[i+1]);
 243                 if (elements->type != ACPI_TYPE_PACKAGE ||
 244                     elements->package.count != 6) {
 245                         ret = -EFAULT;
 246                         goto free_buffer;
 247                 }
 248                 ppcc = elements->package.elements;
 249                 proc_priv->power_limits[i].index = ppcc[0].integer.value;
 250                 proc_priv->power_limits[i].min_uw = ppcc[1].integer.value;
 251                 proc_priv->power_limits[i].max_uw = ppcc[2].integer.value;
 252                 proc_priv->power_limits[i].tmin_us = ppcc[3].integer.value;
 253                 proc_priv->power_limits[i].tmax_us = ppcc[4].integer.value;
 254                 proc_priv->power_limits[i].step_uw = ppcc[5].integer.value;
 255         }
 256
 257 free_buffer:
 258         kfree(buf.pointer);
 259
 260         return ret;
 261 }
 262
 263 #define PROC_POWER_CAPABILITY_CHANGED   0x83
 264 static void proc_thermal_notify(acpi_handle handle, u32 event, void *data)
 265 {
 266         struct proc_thermal_device *proc_priv = data;
 267
 268         if (!proc_priv)
 269                 return;
 270
 271         switch (event) {
 272         case PROC_POWER_CAPABILITY_CHANGED:
 273                 proc_thermal_read_ppcc(proc_priv);
 274                 int340x_thermal_zone_device_update(proc_priv->int340x_zone,
 275                                 THERMAL_DEVICE_POWER_CAPABILITY_CHANGED);
 276                 break;
 277         default:
 278                 dev_dbg(proc_priv->dev, "Unsupported event [0x%x]\n", event);
 279                 break;
 280         }
 281 }
 282
 283 int proc_thermal_add(struct device *dev, struct proc_thermal_device *proc_priv)
 284 {
 285         struct acpi_device *adev;
 286         acpi_status status;
 287         unsigned long long tmp;
 288         struct thermal_zone_device_ops *ops = NULL;
 289         int ret;
 290
 291         adev = ACPI_COMPANION(dev);
 292         if (!adev)
 293                 return -ENODEV;
 294
 295         proc_priv->dev = dev;
 296         proc_priv->adev = adev;
 297
 298         ret = proc_thermal_read_ppcc(proc_priv);
 299         if (ret)
 300                 return ret;
 301
 302         status = acpi_evaluate_integer(adev->handle, "_TMP", NULL, &tmp);
 303         if (ACPI_FAILURE(status)) {
 304                 /* there is no _TMP method, add local method */
 305                 stored_tjmax = get_tjmax();
 306                 if (stored_tjmax > 0)
 307                         ops = &proc_thermal_local_ops;
 308         }
 309
 310         proc_priv->int340x_zone = int340x_thermal_zone_add(adev, ops);
 311         if (IS_ERR(proc_priv->int340x_zone)) {
 312                 return PTR_ERR(proc_priv->int340x_zone);
 313         } else
 314                 ret = 0;
 315
 316         ret = acpi_install_notify_handler(adev->handle, ACPI_DEVICE_NOTIFY,
 317                                           proc_thermal_notify,
 318                                           (void *)proc_priv);
 319         if (ret)
 320                 goto remove_zone;
 321
 322         ret = sysfs_create_file(&dev->kobj, &dev_attr_tcc_offset_degree_celsius.attr);
 323         if (ret)
 324                 goto remove_notify;
 325
 326         ret = sysfs_create_group(&dev->kobj, &power_limit_attribute_group);
 327         if (ret) {
 328                 sysfs_remove_file(&dev->kobj, &dev_attr_tcc_offset_degree_celsius.attr);
 329                 goto remove_notify;
 330         }
 331
 332         return 0;
 333
 334 remove_notify:
 335         acpi_remove_notify_handler(adev->handle,
 336                                     ACPI_DEVICE_NOTIFY, proc_thermal_notify);
 337 remove_zone:
 338         int340x_thermal_zone_remove(proc_priv->int340x_zone);
 339
 340         return ret;
 341 }
 342 EXPORT_SYMBOL_GPL(proc_thermal_add);
 343
 344 void proc_thermal_remove(struct proc_thermal_device *proc_priv)
 345 {
 346         acpi_remove_notify_handler(proc_priv->adev->handle,
 347                                    ACPI_DEVICE_NOTIFY, proc_thermal_notify);
 348         int340x_thermal_zone_remove(proc_priv->int340x_zone);
 349         sysfs_remove_file(&proc_priv->dev->kobj, &dev_attr_tcc_offset_degree_celsius.attr);
 350         sysfs_remove_group(&proc_priv->dev->kobj,
 351                            &power_limit_attribute_group);
 352 }
 353 EXPORT_SYMBOL_GPL(proc_thermal_remove);
 354
 355 static int tcc_offset_save = -1;
 356
 357 int proc_thermal_suspend(struct device *dev)
 358 {
 359         tcc_offset_save = tcc_get_offset();
 360         if (tcc_offset_save < 0)
 361                 dev_warn(dev, "failed to save offset (%d)\n", tcc_offset_save);
 362
 363         return 0;
 364 }
 365 EXPORT_SYMBOL_GPL(proc_thermal_suspend);
 366
 367 int proc_thermal_resume(struct device *dev)
 368 {
 369         struct proc_thermal_device *proc_dev;
 370
 371         proc_dev = dev_get_drvdata(dev);
 372         proc_thermal_read_ppcc(proc_dev);
 373
 374         /* Do not update if saving failed */
 375         if (tcc_offset_save >= 0)
 376                 tcc_offset_update(tcc_offset_save);
 377
 378         return 0;
 379 }
 380 EXPORT_SYMBOL_GPL(proc_thermal_resume);
 381
 382 #define MCHBAR 0
 383
 384 static int proc_thermal_set_mmio_base(struct pci_dev *pdev, struct proc_thermal_device *proc_priv)
 385 {
 386         int ret;
 387
 388         ret = pcim_iomap_regions(pdev, 1 << MCHBAR, DRV_NAME);
 389         if (ret) {
 390                 dev_err(&pdev->dev, "cannot reserve PCI memory region\n");
 391                 return -ENOMEM;
 392         }
 393
 394         proc_priv->mmio_base = pcim_iomap_table(pdev)[MCHBAR];
 395
 396         return 0;
 397 }
 398
 399 int proc_thermal_mmio_add(struct pci_dev *pdev,
 400                           struct proc_thermal_device *proc_priv,
 401                           kernel_ulong_t feature_mask)
 402 {
 403         int ret;
 404
 405         proc_priv->mmio_feature_mask = feature_mask;
 406
 407         if (feature_mask) {
 408                 ret = proc_thermal_set_mmio_base(pdev, proc_priv);
 409                 if (ret)
 410                         return ret;
 411         }
 412
 413         if (feature_mask & PROC_THERMAL_FEATURE_RAPL) {
 414                 ret = proc_thermal_rapl_add(pdev, proc_priv);
 415                 if (ret) {
 416                         dev_err(&pdev->dev, "failed to add RAPL MMIO interface\n");
 417                         return ret;
 418                 }
 419         }
 420
 421         if (feature_mask & PROC_THERMAL_FEATURE_FIVR ||
 422             feature_mask & PROC_THERMAL_FEATURE_DVFS) {
 423                 ret = proc_thermal_rfim_add(pdev, proc_priv);
 424                 if (ret) {
 425                         dev_err(&pdev->dev, "failed to add RFIM interface\n");
 426                         goto err_rem_rapl;
 427                 }
 428         }
 429
 430         if (feature_mask & PROC_THERMAL_FEATURE_MBOX) {
 431                 ret = proc_thermal_mbox_add(pdev, proc_priv);
 432                 if (ret) {
 433                         dev_err(&pdev->dev, "failed to add MBOX interface\n");
 434                         goto err_rem_rfim;
 435                 }
 436         }
 437
 438         return 0;
 439
 440 err_rem_rfim:
 441         proc_thermal_rfim_remove(pdev);
 442 err_rem_rapl:
 443         proc_thermal_rapl_remove();
 444
 445         return ret;
 446 }
 447 EXPORT_SYMBOL_GPL(proc_thermal_mmio_add);
 448
 449 void proc_thermal_mmio_remove(struct pci_dev *pdev, struct proc_thermal_device *proc_priv)
 450 {
 451         if (proc_priv->mmio_feature_mask & PROC_THERMAL_FEATURE_RAPL)
 452                 proc_thermal_rapl_remove();
 453
 454         if (proc_priv->mmio_feature_mask & PROC_THERMAL_FEATURE_FIVR ||
 455             proc_priv->mmio_feature_mask & PROC_THERMAL_FEATURE_DVFS)
 456                 proc_thermal_rfim_remove(pdev);
 457
 458         if (proc_priv->mmio_feature_mask & PROC_THERMAL_FEATURE_MBOX)
 459                 proc_thermal_mbox_remove(pdev);
 460 }
 461 EXPORT_SYMBOL_GPL(proc_thermal_mmio_remove);
 462
 463 MODULE_AUTHOR("Srinivas Pandruvada <[email protected]>");
 464 MODULE_DESCRIPTION("Processor Thermal Reporting Device Driver");
 465 MODULE_LICENSE("GPL v2");