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