drivers/thermal/thermal_sysfs.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /*
   3  *  thermal.c - sysfs interface of thermal devices
   4  *
   5  *  Copyright (C) 2016 Eduardo Valentin <edubezval@gmail.com>
   6  *
   7  *  Highly based on original thermal_core.c
   8  *  Copyright (C) 2008 Intel Corp
   9  *  Copyright (C) 2008 Zhang Rui <rui.zhang@intel.com>
  10  *  Copyright (C) 2008 Sujith Thomas <sujith.thomas@intel.com>
  11  */
  12
  13 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  14
  15 #include <linux/sysfs.h>
  16 #include <linux/device.h>
  17 #include <linux/err.h>
  18 #include <linux/slab.h>
  19 #include <linux/string.h>
  20 #include <linux/jiffies.h>
  21
  22 #include "thermal_core.h"
  23
  24 /* sys I/F for thermal zone */
  25
  26 static ssize_t
  27 type_show(struct device *dev, struct device_attribute *attr, char *buf)
  28 {
  29         struct thermal_zone_device *tz = to_thermal_zone(dev);
  30
  31         return sprintf(buf, "%s\n", tz->type);
  32 }
  33
  34 static ssize_t
  35 temp_show(struct device *dev, struct device_attribute *attr, char *buf)
  36 {
  37         struct thermal_zone_device *tz = to_thermal_zone(dev);
  38         int temperature, ret;
  39
  40         ret = thermal_zone_get_temp(tz, &temperature);
  41
  42         if (ret)
  43                 return ret;
  44
  45         return sprintf(buf, "%d\n", temperature);
  46 }
  47
  48 static ssize_t
  49 mode_show(struct device *dev, struct device_attribute *attr, char *buf)
  50 {
  51         struct thermal_zone_device *tz = to_thermal_zone(dev);
  52         enum thermal_device_mode mode;
  53         int result;
  54
  55         if (!tz->ops->get_mode)
  56                 return -EPERM;
  57
  58         result = tz->ops->get_mode(tz, &mode);
  59         if (result)
  60                 return result;
  61
  62         return sprintf(buf, "%s\n", mode == THERMAL_DEVICE_ENABLED ? "enabled"
  63                        : "disabled");
  64 }
  65
  66 static ssize_t
  67 mode_store(struct device *dev, struct device_attribute *attr,
  68            const char *buf, size_t count)
  69 {
  70         struct thermal_zone_device *tz = to_thermal_zone(dev);
  71         int result;
  72
  73         if (!tz->ops->set_mode)
  74                 return -EPERM;
  75
  76         if (!strncmp(buf, "enabled", sizeof("enabled") - 1))
  77                 result = tz->ops->set_mode(tz, THERMAL_DEVICE_ENABLED);
  78         else if (!strncmp(buf, "disabled", sizeof("disabled") - 1))
  79                 result = tz->ops->set_mode(tz, THERMAL_DEVICE_DISABLED);
  80         else
  81                 result = -EINVAL;
  82
  83         if (result)
  84                 return result;
  85
  86         return count;
  87 }
  88
  89 static ssize_t
  90 trip_point_type_show(struct device *dev, struct device_attribute *attr,
  91                      char *buf)
  92 {
  93         struct thermal_zone_device *tz = to_thermal_zone(dev);
  94         enum thermal_trip_type type;
  95         int trip, result;
  96
  97         if (!tz->ops->get_trip_type)
  98                 return -EPERM;
  99
 100         if (sscanf(attr->attr.name, "trip_point_%d_type", &trip) != 1)
 101                 return -EINVAL;
 102
 103         result = tz->ops->get_trip_type(tz, trip, &type);
 104         if (result)
 105                 return result;
 106
 107         switch (type) {
 108         case THERMAL_TRIP_CRITICAL:
 109                 return sprintf(buf, "critical\n");
 110         case THERMAL_TRIP_HOT:
 111                 return sprintf(buf, "hot\n");
 112         case THERMAL_TRIP_PASSIVE:
 113                 return sprintf(buf, "passive\n");
 114         case THERMAL_TRIP_ACTIVE:
 115                 return sprintf(buf, "active\n");
 116         default:
 117                 return sprintf(buf, "unknown\n");
 118         }
 119 }
 120
 121 static ssize_t
 122 trip_point_temp_store(struct device *dev, struct device_attribute *attr,
 123                       const char *buf, size_t count)
 124 {
 125         struct thermal_zone_device *tz = to_thermal_zone(dev);
 126         int trip, ret;
 127         int temperature;
 128
 129         if (!tz->ops->set_trip_temp)
 130                 return -EPERM;
 131
 132         if (sscanf(attr->attr.name, "trip_point_%d_temp", &trip) != 1)
 133                 return -EINVAL;
 134
 135         if (kstrtoint(buf, 10, &temperature))
 136                 return -EINVAL;
 137
 138         ret = tz->ops->set_trip_temp(tz, trip, temperature);
 139         if (ret)
 140                 return ret;
 141
 142         thermal_zone_device_update(tz, THERMAL_EVENT_UNSPECIFIED);
 143
 144         return count;
 145 }
 146
 147 static ssize_t
 148 trip_point_temp_show(struct device *dev, struct device_attribute *attr,
 149                      char *buf)
 150 {
 151         struct thermal_zone_device *tz = to_thermal_zone(dev);
 152         int trip, ret;
 153         int temperature;
 154
 155         if (!tz->ops->get_trip_temp)
 156                 return -EPERM;
 157
 158         if (sscanf(attr->attr.name, "trip_point_%d_temp", &trip) != 1)
 159                 return -EINVAL;
 160
 161         ret = tz->ops->get_trip_temp(tz, trip, &temperature);
 162
 163         if (ret)
 164                 return ret;
 165
 166         return sprintf(buf, "%d\n", temperature);
 167 }
 168
 169 static ssize_t
 170 trip_point_hyst_store(struct device *dev, struct device_attribute *attr,
 171                       const char *buf, size_t count)
 172 {
 173         struct thermal_zone_device *tz = to_thermal_zone(dev);
 174         int trip, ret;
 175         int temperature;
 176
 177         if (!tz->ops->set_trip_hyst)
 178                 return -EPERM;
 179
 180         if (sscanf(attr->attr.name, "trip_point_%d_hyst", &trip) != 1)
 181                 return -EINVAL;
 182
 183         if (kstrtoint(buf, 10, &temperature))
 184                 return -EINVAL;
 185
 186         /*
 187          * We are not doing any check on the 'temperature' value
 188          * here. The driver implementing 'set_trip_hyst' has to
 189          * take care of this.
 190          */
 191         ret = tz->ops->set_trip_hyst(tz, trip, temperature);
 192
 193         if (!ret)
 194                 thermal_zone_set_trips(tz);
 195
 196         return ret ? ret : count;
 197 }
 198
 199 static ssize_t
 200 trip_point_hyst_show(struct device *dev, struct device_attribute *attr,
 201                      char *buf)
 202 {
 203         struct thermal_zone_device *tz = to_thermal_zone(dev);
 204         int trip, ret;
 205         int temperature;
 206
 207         if (!tz->ops->get_trip_hyst)
 208                 return -EPERM;
 209
 210         if (sscanf(attr->attr.name, "trip_point_%d_hyst", &trip) != 1)
 211                 return -EINVAL;
 212
 213         ret = tz->ops->get_trip_hyst(tz, trip, &temperature);
 214
 215         return ret ? ret : sprintf(buf, "%d\n", temperature);
 216 }
 217
 218 static ssize_t
 219 passive_store(struct device *dev, struct device_attribute *attr,
 220               const char *buf, size_t count)
 221 {
 222         struct thermal_zone_device *tz = to_thermal_zone(dev);
 223         int state;
 224
 225         if (sscanf(buf, "%d\n", &state) != 1)
 226                 return -EINVAL;
 227
 228         /* sanity check: values below 1000 millicelcius don't make sense
 229          * and can cause the system to go into a thermal heart attack
 230          */
 231         if (state && state < 1000)
 232                 return -EINVAL;
 233
 234         if (state && !tz->forced_passive) {
 235                 if (!tz->passive_delay)
 236                         tz->passive_delay = 1000;
 237                 thermal_zone_device_rebind_exception(tz, "Processor",
 238                                                      sizeof("Processor"));
 239         } else if (!state && tz->forced_passive) {
 240                 tz->passive_delay = 0;
 241                 thermal_zone_device_unbind_exception(tz, "Processor",
 242                                                      sizeof("Processor"));
 243         }
 244
 245         tz->forced_passive = state;
 246
 247         thermal_zone_device_update(tz, THERMAL_EVENT_UNSPECIFIED);
 248
 249         return count;
 250 }
 251
 252 static ssize_t
 253 passive_show(struct device *dev, struct device_attribute *attr,
 254              char *buf)
 255 {
 256         struct thermal_zone_device *tz = to_thermal_zone(dev);
 257
 258         return sprintf(buf, "%d\n", tz->forced_passive);
 259 }
 260
 261 static ssize_t
 262 policy_store(struct device *dev, struct device_attribute *attr,
 263              const char *buf, size_t count)
 264 {
 265         struct thermal_zone_device *tz = to_thermal_zone(dev);
 266         char name[THERMAL_NAME_LENGTH];
 267         int ret;
 268
 269         snprintf(name, sizeof(name), "%s", buf);
 270
 271         ret = thermal_zone_device_set_policy(tz, name);
 272         if (!ret)
 273                 ret = count;
 274
 275         return ret;
 276 }
 277
 278 static ssize_t
 279 policy_show(struct device *dev, struct device_attribute *devattr, char *buf)
 280 {
 281         struct thermal_zone_device *tz = to_thermal_zone(dev);
 282
 283         return sprintf(buf, "%s\n", tz->governor->name);
 284 }
 285
 286 static ssize_t
 287 available_policies_show(struct device *dev, struct device_attribute *devattr,
 288                         char *buf)
 289 {
 290         return thermal_build_list_of_policies(buf);
 291 }
 292
 293 #if (IS_ENABLED(CONFIG_THERMAL_EMULATION))
 294 static ssize_t
 295 emul_temp_store(struct device *dev, struct device_attribute *attr,
 296                 const char *buf, size_t count)
 297 {
 298         struct thermal_zone_device *tz = to_thermal_zone(dev);
 299         int ret = 0;
 300         int temperature;
 301
 302         if (kstrtoint(buf, 10, &temperature))
 303                 return -EINVAL;
 304
 305         if (!tz->ops->set_emul_temp) {
 306                 mutex_lock(&tz->lock);
 307                 tz->emul_temperature = temperature;
 308                 mutex_unlock(&tz->lock);
 309         } else {
 310                 ret = tz->ops->set_emul_temp(tz, temperature);
 311         }
 312
 313         if (!ret)
 314                 thermal_zone_device_update(tz, THERMAL_EVENT_UNSPECIFIED);
 315
 316         return ret ? ret : count;
 317 }
 318 static DEVICE_ATTR_WO(emul_temp);
 319 #endif
 320
 321 static ssize_t
 322 sustainable_power_show(struct device *dev, struct device_attribute *devattr,
 323                        char *buf)
 324 {
 325         struct thermal_zone_device *tz = to_thermal_zone(dev);
 326
 327         if (tz->tzp)
 328                 return sprintf(buf, "%u\n", tz->tzp->sustainable_power);
 329         else
 330                 return -EIO;
 331 }
 332
 333 static ssize_t
 334 sustainable_power_store(struct device *dev, struct device_attribute *devattr,
 335                         const char *buf, size_t count)
 336 {
 337         struct thermal_zone_device *tz = to_thermal_zone(dev);
 338         u32 sustainable_power;
 339
 340         if (!tz->tzp)
 341                 return -EIO;
 342
 343         if (kstrtou32(buf, 10, &sustainable_power))
 344                 return -EINVAL;
 345
 346         tz->tzp->sustainable_power = sustainable_power;
 347
 348         return count;
 349 }
 350
 351 #define create_s32_tzp_attr(name)                                       \
 352         static ssize_t                                                  \
 353         name##_show(struct device *dev, struct device_attribute *devattr, \
 354                 char *buf)                                              \
 355         {                                                               \
 356         struct thermal_zone_device *tz = to_thermal_zone(dev);          \
 357                                                                         \
 358         if (tz->tzp)                                                    \
 359                 return sprintf(buf, "%d\n", tz->tzp->name);             \
 360         else                                                            \
 361                 return -EIO;                                            \
 362         }                                                               \
 363                                                                         \
 364         static ssize_t                                                  \
 365         name##_store(struct device *dev, struct device_attribute *devattr, \
 366                 const char *buf, size_t count)                          \
 367         {                                                               \
 368                 struct thermal_zone_device *tz = to_thermal_zone(dev);  \
 369                 s32 value;                                              \
 370                                                                         \
 371                 if (!tz->tzp)                                           \
 372                         return -EIO;                                    \
 373                                                                         \
 374                 if (kstrtos32(buf, 10, &value))                         \
 375                         return -EINVAL;                                 \
 376                                                                         \
 377                 tz->tzp->name = value;                                  \
 378                                                                         \
 379                 return count;                                           \
 380         }                                                               \
 381         static DEVICE_ATTR_RW(name)
 382
 383 create_s32_tzp_attr(k_po);
 384 create_s32_tzp_attr(k_pu);
 385 create_s32_tzp_attr(k_i);
 386 create_s32_tzp_attr(k_d);
 387 create_s32_tzp_attr(integral_cutoff);
 388 create_s32_tzp_attr(slope);
 389 create_s32_tzp_attr(offset);
 390 #undef create_s32_tzp_attr
 391
 392 /*
 393  * These are thermal zone device attributes that will always be present.
 394  * All the attributes created for tzp (create_s32_tzp_attr) also are always
 395  * present on the sysfs interface.
 396  */
 397 static DEVICE_ATTR_RO(type);
 398 static DEVICE_ATTR_RO(temp);
 399 static DEVICE_ATTR_RW(policy);
 400 static DEVICE_ATTR_RO(available_policies);
 401 static DEVICE_ATTR_RW(sustainable_power);
 402
 403 /* These thermal zone device attributes are created based on conditions */
 404 static DEVICE_ATTR_RW(mode);
 405 static DEVICE_ATTR_RW(passive);
 406
 407 /* These attributes are unconditionally added to a thermal zone */
 408 static struct attribute *thermal_zone_dev_attrs[] = {
 409         &dev_attr_type.attr,
 410         &dev_attr_temp.attr,
 411 #if (IS_ENABLED(CONFIG_THERMAL_EMULATION))
 412         &dev_attr_emul_temp.attr,
 413 #endif
 414         &dev_attr_policy.attr,
 415         &dev_attr_available_policies.attr,
 416         &dev_attr_sustainable_power.attr,
 417         &dev_attr_k_po.attr,
 418         &dev_attr_k_pu.attr,
 419         &dev_attr_k_i.attr,
 420         &dev_attr_k_d.attr,
 421         &dev_attr_integral_cutoff.attr,
 422         &dev_attr_slope.attr,
 423         &dev_attr_offset.attr,
 424         NULL,
 425 };
 426
 427 static struct attribute_group thermal_zone_attribute_group = {
 428         .attrs = thermal_zone_dev_attrs,
 429 };
 430
 431 /* We expose mode only if .get_mode is present */
 432 static struct attribute *thermal_zone_mode_attrs[] = {
 433         &dev_attr_mode.attr,
 434         NULL,
 435 };
 436
 437 static umode_t thermal_zone_mode_is_visible(struct kobject *kobj,
 438                                             struct attribute *attr,
 439                                             int attrno)
 440 {
 441         struct device *dev = container_of(kobj, struct device, kobj);
 442         struct thermal_zone_device *tz;
 443
 444         tz = container_of(dev, struct thermal_zone_device, device);
 445
 446         if (tz->ops->get_mode)
 447                 return attr->mode;
 448
 449         return 0;
 450 }
 451
 452 static struct attribute_group thermal_zone_mode_attribute_group = {
 453         .attrs = thermal_zone_mode_attrs,
 454         .is_visible = thermal_zone_mode_is_visible,
 455 };
 456
 457 /* We expose passive only if passive trips are present */
 458 static struct attribute *thermal_zone_passive_attrs[] = {
 459         &dev_attr_passive.attr,
 460         NULL,
 461 };
 462
 463 static umode_t thermal_zone_passive_is_visible(struct kobject *kobj,
 464                                                struct attribute *attr,
 465                                                int attrno)
 466 {
 467         struct device *dev = container_of(kobj, struct device, kobj);
 468         struct thermal_zone_device *tz;
 469         enum thermal_trip_type trip_type;
 470         int count, passive = 0;
 471
 472         tz = container_of(dev, struct thermal_zone_device, device);
 473
 474         for (count = 0; count < tz->trips && !passive; count++) {
 475                 tz->ops->get_trip_type(tz, count, &trip_type);
 476
 477                 if (trip_type == THERMAL_TRIP_PASSIVE)
 478                         passive = 1;
 479         }
 480
 481         if (!passive)
 482                 return attr->mode;
 483
 484         return 0;
 485 }
 486
 487 static struct attribute_group thermal_zone_passive_attribute_group = {
 488         .attrs = thermal_zone_passive_attrs,
 489         .is_visible = thermal_zone_passive_is_visible,
 490 };
 491
 492 static const struct attribute_group *thermal_zone_attribute_groups[] = {
 493         &thermal_zone_attribute_group,
 494         &thermal_zone_mode_attribute_group,
 495         &thermal_zone_passive_attribute_group,
 496         /* This is not NULL terminated as we create the group dynamically */
 497 };
 498
 499 /**
 500  * create_trip_attrs() - create attributes for trip points
 501  * @tz:         the thermal zone device
 502  * @mask:       Writeable trip point bitmap.
 503  *
 504  * helper function to instantiate sysfs entries for every trip
 505  * point and its properties of a struct thermal_zone_device.
 506  *
 507  * Return: 0 on success, the proper error value otherwise.
 508  */
 509 static int create_trip_attrs(struct thermal_zone_device *tz, int mask)
 510 {
 511         struct attribute **attrs;
 512         int indx;
 513
 514         /* This function works only for zones with at least one trip */
 515         if (tz->trips <= 0)
 516                 return -EINVAL;
 517
 518         tz->trip_type_attrs = kcalloc(tz->trips, sizeof(*tz->trip_type_attrs),
 519                                       GFP_KERNEL);
 520         if (!tz->trip_type_attrs)
 521                 return -ENOMEM;
 522
 523         tz->trip_temp_attrs = kcalloc(tz->trips, sizeof(*tz->trip_temp_attrs),
 524                                       GFP_KERNEL);
 525         if (!tz->trip_temp_attrs) {
 526                 kfree(tz->trip_type_attrs);
 527                 return -ENOMEM;
 528         }
 529
 530         if (tz->ops->get_trip_hyst) {
 531                 tz->trip_hyst_attrs = kcalloc(tz->trips,
 532                                               sizeof(*tz->trip_hyst_attrs),
 533                                               GFP_KERNEL);
 534                 if (!tz->trip_hyst_attrs) {
 535                         kfree(tz->trip_type_attrs);
 536                         kfree(tz->trip_temp_attrs);
 537                         return -ENOMEM;
 538                 }
 539         }
 540
 541         attrs = kcalloc(tz->trips * 3 + 1, sizeof(*attrs), GFP_KERNEL);
 542         if (!attrs) {
 543                 kfree(tz->trip_type_attrs);
 544                 kfree(tz->trip_temp_attrs);
 545                 if (tz->ops->get_trip_hyst)
 546                         kfree(tz->trip_hyst_attrs);
 547                 return -ENOMEM;
 548         }
 549
 550         for (indx = 0; indx < tz->trips; indx++) {
 551                 /* create trip type attribute */
 552                 snprintf(tz->trip_type_attrs[indx].name, THERMAL_NAME_LENGTH,
 553                          "trip_point_%d_type", indx);
 554
 555                 sysfs_attr_init(&tz->trip_type_attrs[indx].attr.attr);
 556                 tz->trip_type_attrs[indx].attr.attr.name =
 557                                                 tz->trip_type_attrs[indx].name;
 558                 tz->trip_type_attrs[indx].attr.attr.mode = S_IRUGO;
 559                 tz->trip_type_attrs[indx].attr.show = trip_point_type_show;
 560                 attrs[indx] = &tz->trip_type_attrs[indx].attr.attr;
 561
 562                 /* create trip temp attribute */
 563                 snprintf(tz->trip_temp_attrs[indx].name, THERMAL_NAME_LENGTH,
 564                          "trip_point_%d_temp", indx);
 565
 566                 sysfs_attr_init(&tz->trip_temp_attrs[indx].attr.attr);
 567                 tz->trip_temp_attrs[indx].attr.attr.name =
 568                                                 tz->trip_temp_attrs[indx].name;
 569                 tz->trip_temp_attrs[indx].attr.attr.mode = S_IRUGO;
 570                 tz->trip_temp_attrs[indx].attr.show = trip_point_temp_show;
 571                 if (IS_ENABLED(CONFIG_THERMAL_WRITABLE_TRIPS) &&
 572                     mask & (1 << indx)) {
 573                         tz->trip_temp_attrs[indx].attr.attr.mode |= S_IWUSR;
 574                         tz->trip_temp_attrs[indx].attr.store =
 575                                                         trip_point_temp_store;
 576                 }
 577                 attrs[indx + tz->trips] = &tz->trip_temp_attrs[indx].attr.attr;
 578
 579                 /* create Optional trip hyst attribute */
 580                 if (!tz->ops->get_trip_hyst)
 581                         continue;
 582                 snprintf(tz->trip_hyst_attrs[indx].name, THERMAL_NAME_LENGTH,
 583                          "trip_point_%d_hyst", indx);
 584
 585                 sysfs_attr_init(&tz->trip_hyst_attrs[indx].attr.attr);
 586                 tz->trip_hyst_attrs[indx].attr.attr.name =
 587                                         tz->trip_hyst_attrs[indx].name;
 588                 tz->trip_hyst_attrs[indx].attr.attr.mode = S_IRUGO;
 589                 tz->trip_hyst_attrs[indx].attr.show = trip_point_hyst_show;
 590                 if (tz->ops->set_trip_hyst) {
 591                         tz->trip_hyst_attrs[indx].attr.attr.mode |= S_IWUSR;
 592                         tz->trip_hyst_attrs[indx].attr.store =
 593                                         trip_point_hyst_store;
 594                 }
 595                 attrs[indx + tz->trips * 2] =
 596                                         &tz->trip_hyst_attrs[indx].attr.attr;
 597         }
 598         attrs[tz->trips * 3] = NULL;
 599
 600         tz->trips_attribute_group.attrs = attrs;
 601
 602         return 0;
 603 }
 604
 605 /**
 606  * destroy_trip_attrs() - destroy attributes for trip points
 607  * @tz:         the thermal zone device
 608  *
 609  * helper function to free resources allocated by create_trip_attrs()
 610  */
 611 static void destroy_trip_attrs(struct thermal_zone_device *tz)
 612 {
 613         if (!tz)
 614                 return;
 615
 616         kfree(tz->trip_type_attrs);
 617         kfree(tz->trip_temp_attrs);
 618         if (tz->ops->get_trip_hyst)
 619                 kfree(tz->trip_hyst_attrs);
 620         kfree(tz->trips_attribute_group.attrs);
 621 }
 622
 623 int thermal_zone_create_device_groups(struct thermal_zone_device *tz,
 624                                       int mask)
 625 {
 626         const struct attribute_group **groups;
 627         int i, size, result;
 628
 629         /* we need one extra for trips and the NULL to terminate the array */
 630         size = ARRAY_SIZE(thermal_zone_attribute_groups) + 2;
 631         /* This also takes care of API requirement to be NULL terminated */
 632         groups = kcalloc(size, sizeof(*groups), GFP_KERNEL);
 633         if (!groups)
 634                 return -ENOMEM;
 635
 636         for (i = 0; i < size - 2; i++)
 637                 groups[i] = thermal_zone_attribute_groups[i];
 638
 639         if (tz->trips) {
 640                 result = create_trip_attrs(tz, mask);
 641                 if (result) {
 642                         kfree(groups);
 643
 644                         return result;
 645                 }
 646
 647                 groups[size - 2] = &tz->trips_attribute_group;
 648         }
 649
 650         tz->device.groups = groups;
 651
 652         return 0;
 653 }
 654
 655 void thermal_zone_destroy_device_groups(struct thermal_zone_device *tz)
 656 {
 657         if (!tz)
 658                 return;
 659
 660         if (tz->trips)
 661                 destroy_trip_attrs(tz);
 662
 663         kfree(tz->device.groups);
 664 }
 665
 666 /* sys I/F for cooling device */
 667 static ssize_t
 668 cdev_type_show(struct device *dev, struct device_attribute *attr, char *buf)
 669 {
 670         struct thermal_cooling_device *cdev = to_cooling_device(dev);
 671
 672         return sprintf(buf, "%s\n", cdev->type);
 673 }
 674
 675 static ssize_t max_state_show(struct device *dev, struct device_attribute *attr,
 676                               char *buf)
 677 {
 678         struct thermal_cooling_device *cdev = to_cooling_device(dev);
 679         unsigned long state;
 680         int ret;
 681
 682         ret = cdev->ops->get_max_state(cdev, &state);
 683         if (ret)
 684                 return ret;
 685         return sprintf(buf, "%ld\n", state);
 686 }
 687
 688 static ssize_t cur_state_show(struct device *dev, struct device_attribute *attr,
 689                               char *buf)
 690 {
 691         struct thermal_cooling_device *cdev = to_cooling_device(dev);
 692         unsigned long state;
 693         int ret;
 694
 695         ret = cdev->ops->get_cur_state(cdev, &state);
 696         if (ret)
 697                 return ret;
 698         return sprintf(buf, "%ld\n", state);
 699 }
 700
 701 static ssize_t
 702 cur_state_store(struct device *dev, struct device_attribute *attr,
 703                 const char *buf, size_t count)
 704 {
 705         struct thermal_cooling_device *cdev = to_cooling_device(dev);
 706         unsigned long state;
 707         int result;
 708
 709         if (sscanf(buf, "%ld\n", &state) != 1)
 710                 return -EINVAL;
 711
 712         if ((long)state < 0)
 713                 return -EINVAL;
 714
 715         result = cdev->ops->set_cur_state(cdev, state);
 716         if (result)
 717                 return result;
 718         thermal_cooling_device_stats_update(cdev, state);
 719         return count;
 720 }
 721
 722 static struct device_attribute
 723 dev_attr_cdev_type = __ATTR(type, 0444, cdev_type_show, NULL);
 724 static DEVICE_ATTR_RO(max_state);
 725 static DEVICE_ATTR_RW(cur_state);
 726
 727 static struct attribute *cooling_device_attrs[] = {
 728         &dev_attr_cdev_type.attr,
 729         &dev_attr_max_state.attr,
 730         &dev_attr_cur_state.attr,
 731         NULL,
 732 };
 733
 734 static const struct attribute_group cooling_device_attr_group = {
 735         .attrs = cooling_device_attrs,
 736 };
 737
 738 static const struct attribute_group *cooling_device_attr_groups[] = {
 739         &cooling_device_attr_group,
 740         NULL, /* Space allocated for cooling_device_stats_attr_group */
 741         NULL,
 742 };
 743
 744 #ifdef CONFIG_THERMAL_STATISTICS
 745 struct cooling_dev_stats {
 746         spinlock_t lock;
 747         unsigned int total_trans;
 748         unsigned long state;
 749         unsigned long max_states;
 750         ktime_t last_time;
 751         ktime_t *time_in_state;
 752         unsigned int *trans_table;
 753 };
 754
 755 static void update_time_in_state(struct cooling_dev_stats *stats)
 756 {
 757         ktime_t now = ktime_get(), delta;
 758
 759         delta = ktime_sub(now, stats->last_time);
 760         stats->time_in_state[stats->state] =
 761                 ktime_add(stats->time_in_state[stats->state], delta);
 762         stats->last_time = now;
 763 }
 764
 765 void thermal_cooling_device_stats_update(struct thermal_cooling_device *cdev,
 766                                          unsigned long new_state)
 767 {
 768         struct cooling_dev_stats *stats = cdev->stats;
 769
 770         spin_lock(&stats->lock);
 771
 772         if (stats->state == new_state)
 773                 goto unlock;
 774
 775         update_time_in_state(stats);
 776         stats->trans_table[stats->state * stats->max_states + new_state]++;
 777         stats->state = new_state;
 778         stats->total_trans++;
 779
 780 unlock:
 781         spin_unlock(&stats->lock);
 782 }
 783
 784 static ssize_t total_trans_show(struct device *dev,
 785                                 struct device_attribute *attr, char *buf)
 786 {
 787         struct thermal_cooling_device *cdev = to_cooling_device(dev);
 788         struct cooling_dev_stats *stats = cdev->stats;
 789         int ret;
 790
 791         spin_lock(&stats->lock);
 792         ret = sprintf(buf, "%u\n", stats->total_trans);
 793         spin_unlock(&stats->lock);
 794
 795         return ret;
 796 }
 797
 798 static ssize_t
 799 time_in_state_ms_show(struct device *dev, struct device_attribute *attr,
 800                       char *buf)
 801 {
 802         struct thermal_cooling_device *cdev = to_cooling_device(dev);
 803         struct cooling_dev_stats *stats = cdev->stats;
 804         ssize_t len = 0;
 805         int i;
 806
 807         spin_lock(&stats->lock);
 808         update_time_in_state(stats);
 809
 810         for (i = 0; i < stats->max_states; i++) {
 811                 len += sprintf(buf + len, "state%u\t%llu\n", i,
 812                                ktime_to_ms(stats->time_in_state[i]));
 813         }
 814         spin_unlock(&stats->lock);
 815
 816         return len;
 817 }
 818
 819 static ssize_t
 820 reset_store(struct device *dev, struct device_attribute *attr, const char *buf,
 821             size_t count)
 822 {
 823         struct thermal_cooling_device *cdev = to_cooling_device(dev);
 824         struct cooling_dev_stats *stats = cdev->stats;
 825         int i, states = stats->max_states;
 826
 827         spin_lock(&stats->lock);
 828
 829         stats->total_trans = 0;
 830         stats->last_time = ktime_get();
 831         memset(stats->trans_table, 0,
 832                states * states * sizeof(*stats->trans_table));
 833
 834         for (i = 0; i < stats->max_states; i++)
 835                 stats->time_in_state[i] = ktime_set(0, 0);
 836
 837         spin_unlock(&stats->lock);
 838
 839         return count;
 840 }
 841
 842 static ssize_t trans_table_show(struct device *dev,
 843                                 struct device_attribute *attr, char *buf)
 844 {
 845         struct thermal_cooling_device *cdev = to_cooling_device(dev);
 846         struct cooling_dev_stats *stats = cdev->stats;
 847         ssize_t len = 0;
 848         int i, j;
 849
 850         len += snprintf(buf + len, PAGE_SIZE - len, " From  :    To\n");
 851         len += snprintf(buf + len, PAGE_SIZE - len, "       : ");
 852         for (i = 0; i < stats->max_states; i++) {
 853                 if (len >= PAGE_SIZE)
 854                         break;
 855                 len += snprintf(buf + len, PAGE_SIZE - len, "state%2u  ", i);
 856         }
 857         if (len >= PAGE_SIZE)
 858                 return PAGE_SIZE;
 859
 860         len += snprintf(buf + len, PAGE_SIZE - len, "\n");
 861
 862         for (i = 0; i < stats->max_states; i++) {
 863                 if (len >= PAGE_SIZE)
 864                         break;
 865
 866                 len += snprintf(buf + len, PAGE_SIZE - len, "state%2u:", i);
 867
 868                 for (j = 0; j < stats->max_states; j++) {
 869                         if (len >= PAGE_SIZE)
 870                                 break;
 871                         len += snprintf(buf + len, PAGE_SIZE - len, "%8u ",
 872                                 stats->trans_table[i * stats->max_states + j]);
 873                 }
 874                 if (len >= PAGE_SIZE)
 875                         break;
 876                 len += snprintf(buf + len, PAGE_SIZE - len, "\n");
 877         }
 878
 879         if (len >= PAGE_SIZE) {
 880                 pr_warn_once("Thermal transition table exceeds PAGE_SIZE. Disabling\n");
 881                 return -EFBIG;
 882         }
 883         return len;
 884 }
 885
 886 static DEVICE_ATTR_RO(total_trans);
 887 static DEVICE_ATTR_RO(time_in_state_ms);
 888 static DEVICE_ATTR_WO(reset);
 889 static DEVICE_ATTR_RO(trans_table);
 890
 891 static struct attribute *cooling_device_stats_attrs[] = {
 892         &dev_attr_total_trans.attr,
 893         &dev_attr_time_in_state_ms.attr,
 894         &dev_attr_reset.attr,
 895         &dev_attr_trans_table.attr,
 896         NULL
 897 };
 898
 899 static const struct attribute_group cooling_device_stats_attr_group = {
 900         .attrs = cooling_device_stats_attrs,
 901         .name = "stats"
 902 };
 903
 904 static void cooling_device_stats_setup(struct thermal_cooling_device *cdev)
 905 {
 906         struct cooling_dev_stats *stats;
 907         unsigned long states;
 908         int var;
 909
 910         if (cdev->ops->get_max_state(cdev, &states))
 911                 return;
 912
 913         states++; /* Total number of states is highest state + 1 */
 914
 915         var = sizeof(*stats);
 916         var += sizeof(*stats->time_in_state) * states;
 917         var += sizeof(*stats->trans_table) * states * states;
 918
 919         stats = kzalloc(var, GFP_KERNEL);
 920         if (!stats)
 921                 return;
 922
 923         stats->time_in_state = (ktime_t *)(stats + 1);
 924         stats->trans_table = (unsigned int *)(stats->time_in_state + states);
 925         cdev->stats = stats;
 926         stats->last_time = ktime_get();
 927         stats->max_states = states;
 928
 929         spin_lock_init(&stats->lock);
 930
 931         /* Fill the empty slot left in cooling_device_attr_groups */
 932         var = ARRAY_SIZE(cooling_device_attr_groups) - 2;
 933         cooling_device_attr_groups[var] = &cooling_device_stats_attr_group;
 934 }
 935
 936 static void cooling_device_stats_destroy(struct thermal_cooling_device *cdev)
 937 {
 938         kfree(cdev->stats);
 939         cdev->stats = NULL;
 940 }
 941
 942 #else
 943
 944 static inline void
 945 cooling_device_stats_setup(struct thermal_cooling_device *cdev) {}
 946 static inline void
 947 cooling_device_stats_destroy(struct thermal_cooling_device *cdev) {}
 948
 949 #endif /* CONFIG_THERMAL_STATISTICS */
 950
 951 void thermal_cooling_device_setup_sysfs(struct thermal_cooling_device *cdev)
 952 {
 953         cooling_device_stats_setup(cdev);
 954         cdev->device.groups = cooling_device_attr_groups;
 955 }
 956
 957 void thermal_cooling_device_destroy_sysfs(struct thermal_cooling_device *cdev)
 958 {
 959         cooling_device_stats_destroy(cdev);
 960 }
 961
 962 /* these helper will be used only at the time of bindig */
 963 ssize_t
 964 trip_point_show(struct device *dev, struct device_attribute *attr, char *buf)
 965 {
 966         struct thermal_instance *instance;
 967
 968         instance =
 969             container_of(attr, struct thermal_instance, attr);
 970
 971         if (instance->trip == THERMAL_TRIPS_NONE)
 972                 return sprintf(buf, "-1\n");
 973         else
 974                 return sprintf(buf, "%d\n", instance->trip);
 975 }
 976
 977 ssize_t
 978 weight_show(struct device *dev, struct device_attribute *attr, char *buf)
 979 {
 980         struct thermal_instance *instance;
 981
 982         instance = container_of(attr, struct thermal_instance, weight_attr);
 983
 984         return sprintf(buf, "%d\n", instance->weight);
 985 }
 986
 987 ssize_t weight_store(struct device *dev, struct device_attribute *attr,
 988                      const char *buf, size_t count)
 989 {
 990         struct thermal_instance *instance;
 991         int ret, weight;
 992
 993         ret = kstrtoint(buf, 0, &weight);
 994         if (ret)
 995                 return ret;
 996
 997         instance = container_of(attr, struct thermal_instance, weight_attr);
 998         instance->weight = weight;
 999
1000         return count;
1001 }