drivers/hwmon/gpio-fan.c

   1 // SPDX-License-Identifier: GPL-2.0-or-later
   2 /*
   3  * gpio-fan.c - Hwmon driver for fans connected to GPIO lines.
   4  *
   5  * Copyright (C) 2010 LaCie
   6  *
   7  * Author: Simon Guinot <sguinot@lacie.com>
   8  */
   9
  10 #include <linux/module.h>
  11 #include <linux/init.h>
  12 #include <linux/slab.h>
  13 #include <linux/interrupt.h>
  14 #include <linux/irq.h>
  15 #include <linux/platform_device.h>
  16 #include <linux/err.h>
  17 #include <linux/kstrtox.h>
  18 #include <linux/mutex.h>
  19 #include <linux/hwmon.h>
  20 #include <linux/gpio/consumer.h>
  21 #include <linux/of.h>
  22 #include <linux/of_platform.h>
  23 #include <linux/thermal.h>
  24
  25 struct gpio_fan_speed {
  26         int rpm;
  27         int ctrl_val;
  28 };
  29
  30 struct gpio_fan_data {
  31         struct device           *dev;
  32         struct device           *hwmon_dev;
  33         /* Cooling device if any */
  34         struct thermal_cooling_device *cdev;
  35         struct mutex            lock; /* lock GPIOs operations. */
  36         int                     num_gpios;
  37         struct gpio_desc        **gpios;
  38         int                     num_speed;
  39         struct gpio_fan_speed   *speed;
  40         int                     speed_index;
  41         int                     resume_speed;
  42         bool                    pwm_enable;
  43         struct gpio_desc        *alarm_gpio;
  44         struct work_struct      alarm_work;
  45 };
  46
  47 /*
  48  * Alarm GPIO.
  49  */
  50
  51 static void fan_alarm_notify(struct work_struct *ws)
  52 {
  53         struct gpio_fan_data *fan_data =
  54                 container_of(ws, struct gpio_fan_data, alarm_work);
  55
  56         sysfs_notify(&fan_data->hwmon_dev->kobj, NULL, "fan1_alarm");
  57         kobject_uevent(&fan_data->hwmon_dev->kobj, KOBJ_CHANGE);
  58 }
  59
  60 static irqreturn_t fan_alarm_irq_handler(int irq, void *dev_id)
  61 {
  62         struct gpio_fan_data *fan_data = dev_id;
  63
  64         schedule_work(&fan_data->alarm_work);
  65
  66         return IRQ_NONE;
  67 }
  68
  69 static ssize_t fan1_alarm_show(struct device *dev,
  70                                struct device_attribute *attr, char *buf)
  71 {
  72         struct gpio_fan_data *fan_data = dev_get_drvdata(dev);
  73
  74         return sprintf(buf, "%d\n",
  75                        gpiod_get_value_cansleep(fan_data->alarm_gpio));
  76 }
  77
  78 static DEVICE_ATTR_RO(fan1_alarm);
  79
  80 static int fan_alarm_init(struct gpio_fan_data *fan_data)
  81 {
  82         int alarm_irq;
  83         struct device *dev = fan_data->dev;
  84
  85         /*
  86          * If the alarm GPIO don't support interrupts, just leave
  87          * without initializing the fail notification support.
  88          */
  89         alarm_irq = gpiod_to_irq(fan_data->alarm_gpio);
  90         if (alarm_irq <= 0)
  91                 return 0;
  92
  93         INIT_WORK(&fan_data->alarm_work, fan_alarm_notify);
  94         irq_set_irq_type(alarm_irq, IRQ_TYPE_EDGE_BOTH);
  95         return devm_request_irq(dev, alarm_irq, fan_alarm_irq_handler,
  96                                 IRQF_SHARED, "GPIO fan alarm", fan_data);
  97 }
  98
  99 /*
 100  * Control GPIOs.
 101  */
 102
 103 /* Must be called with fan_data->lock held, except during initialization. */
 104 static void __set_fan_ctrl(struct gpio_fan_data *fan_data, int ctrl_val)
 105 {
 106         int i;
 107
 108         for (i = 0; i < fan_data->num_gpios; i++)
 109                 gpiod_set_value_cansleep(fan_data->gpios[i],
 110                                          (ctrl_val >> i) & 1);
 111 }
 112
 113 static int __get_fan_ctrl(struct gpio_fan_data *fan_data)
 114 {
 115         int i;
 116         int ctrl_val = 0;
 117
 118         for (i = 0; i < fan_data->num_gpios; i++) {
 119                 int value;
 120
 121                 value = gpiod_get_value_cansleep(fan_data->gpios[i]);
 122                 ctrl_val |= (value << i);
 123         }
 124         return ctrl_val;
 125 }
 126
 127 /* Must be called with fan_data->lock held, except during initialization. */
 128 static void set_fan_speed(struct gpio_fan_data *fan_data, int speed_index)
 129 {
 130         if (fan_data->speed_index == speed_index)
 131                 return;
 132
 133         __set_fan_ctrl(fan_data, fan_data->speed[speed_index].ctrl_val);
 134         fan_data->speed_index = speed_index;
 135 }
 136
 137 static int get_fan_speed_index(struct gpio_fan_data *fan_data)
 138 {
 139         int ctrl_val = __get_fan_ctrl(fan_data);
 140         int i;
 141
 142         for (i = 0; i < fan_data->num_speed; i++)
 143                 if (fan_data->speed[i].ctrl_val == ctrl_val)
 144                         return i;
 145
 146         dev_warn(fan_data->dev,
 147                  "missing speed array entry for GPIO value 0x%x\n", ctrl_val);
 148
 149         return -ENODEV;
 150 }
 151
 152 static int rpm_to_speed_index(struct gpio_fan_data *fan_data, unsigned long rpm)
 153 {
 154         struct gpio_fan_speed *speed = fan_data->speed;
 155         int i;
 156
 157         for (i = 0; i < fan_data->num_speed; i++)
 158                 if (speed[i].rpm >= rpm)
 159                         return i;
 160
 161         return fan_data->num_speed - 1;
 162 }
 163
 164 static ssize_t pwm1_show(struct device *dev, struct device_attribute *attr,
 165                          char *buf)
 166 {
 167         struct gpio_fan_data *fan_data = dev_get_drvdata(dev);
 168         u8 pwm = fan_data->speed_index * 255 / (fan_data->num_speed - 1);
 169
 170         return sprintf(buf, "%d\n", pwm);
 171 }
 172
 173 static ssize_t pwm1_store(struct device *dev, struct device_attribute *attr,
 174                           const char *buf, size_t count)
 175 {
 176         struct gpio_fan_data *fan_data = dev_get_drvdata(dev);
 177         unsigned long pwm;
 178         int speed_index;
 179         int ret = count;
 180
 181         if (kstrtoul(buf, 10, &pwm) || pwm > 255)
 182                 return -EINVAL;
 183
 184         mutex_lock(&fan_data->lock);
 185
 186         if (!fan_data->pwm_enable) {
 187                 ret = -EPERM;
 188                 goto exit_unlock;
 189         }
 190
 191         speed_index = DIV_ROUND_UP(pwm * (fan_data->num_speed - 1), 255);
 192         set_fan_speed(fan_data, speed_index);
 193
 194 exit_unlock:
 195         mutex_unlock(&fan_data->lock);
 196
 197         return ret;
 198 }
 199
 200 static ssize_t pwm1_enable_show(struct device *dev,
 201                                 struct device_attribute *attr, char *buf)
 202 {
 203         struct gpio_fan_data *fan_data = dev_get_drvdata(dev);
 204
 205         return sprintf(buf, "%d\n", fan_data->pwm_enable);
 206 }
 207
 208 static ssize_t pwm1_enable_store(struct device *dev,
 209                                  struct device_attribute *attr,
 210                                  const char *buf, size_t count)
 211 {
 212         struct gpio_fan_data *fan_data = dev_get_drvdata(dev);
 213         unsigned long val;
 214
 215         if (kstrtoul(buf, 10, &val) || val > 1)
 216                 return -EINVAL;
 217
 218         if (fan_data->pwm_enable == val)
 219                 return count;
 220
 221         mutex_lock(&fan_data->lock);
 222
 223         fan_data->pwm_enable = val;
 224
 225         /* Disable manual control mode: set fan at full speed. */
 226         if (val == 0)
 227                 set_fan_speed(fan_data, fan_data->num_speed - 1);
 228
 229         mutex_unlock(&fan_data->lock);
 230
 231         return count;
 232 }
 233
 234 static ssize_t pwm1_mode_show(struct device *dev,
 235                               struct device_attribute *attr, char *buf)
 236 {
 237         return sprintf(buf, "0\n");
 238 }
 239
 240 static ssize_t fan1_min_show(struct device *dev,
 241                              struct device_attribute *attr, char *buf)
 242 {
 243         struct gpio_fan_data *fan_data = dev_get_drvdata(dev);
 244
 245         return sprintf(buf, "%d\n", fan_data->speed[0].rpm);
 246 }
 247
 248 static ssize_t fan1_max_show(struct device *dev,
 249                              struct device_attribute *attr, char *buf)
 250 {
 251         struct gpio_fan_data *fan_data = dev_get_drvdata(dev);
 252
 253         return sprintf(buf, "%d\n",
 254                        fan_data->speed[fan_data->num_speed - 1].rpm);
 255 }
 256
 257 static ssize_t fan1_input_show(struct device *dev,
 258                                struct device_attribute *attr, char *buf)
 259 {
 260         struct gpio_fan_data *fan_data = dev_get_drvdata(dev);
 261
 262         return sprintf(buf, "%d\n", fan_data->speed[fan_data->speed_index].rpm);
 263 }
 264
 265 static ssize_t set_rpm(struct device *dev, struct device_attribute *attr,
 266                        const char *buf, size_t count)
 267 {
 268         struct gpio_fan_data *fan_data = dev_get_drvdata(dev);
 269         unsigned long rpm;
 270         int ret = count;
 271
 272         if (kstrtoul(buf, 10, &rpm))
 273                 return -EINVAL;
 274
 275         mutex_lock(&fan_data->lock);
 276
 277         if (!fan_data->pwm_enable) {
 278                 ret = -EPERM;
 279                 goto exit_unlock;
 280         }
 281
 282         set_fan_speed(fan_data, rpm_to_speed_index(fan_data, rpm));
 283
 284 exit_unlock:
 285         mutex_unlock(&fan_data->lock);
 286
 287         return ret;
 288 }
 289
 290 static DEVICE_ATTR_RW(pwm1);
 291 static DEVICE_ATTR_RW(pwm1_enable);
 292 static DEVICE_ATTR_RO(pwm1_mode);
 293 static DEVICE_ATTR_RO(fan1_min);
 294 static DEVICE_ATTR_RO(fan1_max);
 295 static DEVICE_ATTR_RO(fan1_input);
 296 static DEVICE_ATTR(fan1_target, 0644, fan1_input_show, set_rpm);
 297
 298 static umode_t gpio_fan_is_visible(struct kobject *kobj,
 299                                    struct attribute *attr, int index)
 300 {
 301         struct device *dev = kobj_to_dev(kobj);
 302         struct gpio_fan_data *data = dev_get_drvdata(dev);
 303
 304         if (index == 0 && !data->alarm_gpio)
 305                 return 0;
 306         if (index > 0 && !data->gpios)
 307                 return 0;
 308
 309         return attr->mode;
 310 }
 311
 312 static struct attribute *gpio_fan_attributes[] = {
 313         &dev_attr_fan1_alarm.attr,              /* 0 */
 314         &dev_attr_pwm1.attr,                    /* 1 */
 315         &dev_attr_pwm1_enable.attr,
 316         &dev_attr_pwm1_mode.attr,
 317         &dev_attr_fan1_input.attr,
 318         &dev_attr_fan1_target.attr,
 319         &dev_attr_fan1_min.attr,
 320         &dev_attr_fan1_max.attr,
 321         NULL
 322 };
 323
 324 static const struct attribute_group gpio_fan_group = {
 325         .attrs = gpio_fan_attributes,
 326         .is_visible = gpio_fan_is_visible,
 327 };
 328
 329 static const struct attribute_group *gpio_fan_groups[] = {
 330         &gpio_fan_group,
 331         NULL
 332 };
 333
 334 static int fan_ctrl_init(struct gpio_fan_data *fan_data)
 335 {
 336         int num_gpios = fan_data->num_gpios;
 337         struct gpio_desc **gpios = fan_data->gpios;
 338         int i, err;
 339
 340         for (i = 0; i < num_gpios; i++) {
 341                 /*
 342                  * The GPIO descriptors were retrieved with GPIOD_ASIS so here
 343                  * we set the GPIO into output mode, carefully preserving the
 344                  * current value by setting it to whatever it is already set
 345                  * (no surprise changes in default fan speed).
 346                  */
 347                 err = gpiod_direction_output(gpios[i],
 348                                         gpiod_get_value_cansleep(gpios[i]));
 349                 if (err)
 350                         return err;
 351         }
 352
 353         fan_data->pwm_enable = true; /* Enable manual fan speed control. */
 354         fan_data->speed_index = get_fan_speed_index(fan_data);
 355         if (fan_data->speed_index < 0)
 356                 return fan_data->speed_index;
 357
 358         return 0;
 359 }
 360
 361 static int gpio_fan_get_max_state(struct thermal_cooling_device *cdev,
 362                                   unsigned long *state)
 363 {
 364         struct gpio_fan_data *fan_data = cdev->devdata;
 365
 366         if (!fan_data)
 367                 return -EINVAL;
 368
 369         *state = fan_data->num_speed - 1;
 370         return 0;
 371 }
 372
 373 static int gpio_fan_get_cur_state(struct thermal_cooling_device *cdev,
 374                                   unsigned long *state)
 375 {
 376         struct gpio_fan_data *fan_data = cdev->devdata;
 377
 378         if (!fan_data)
 379                 return -EINVAL;
 380
 381         *state = fan_data->speed_index;
 382         return 0;
 383 }
 384
 385 static int gpio_fan_set_cur_state(struct thermal_cooling_device *cdev,
 386                                   unsigned long state)
 387 {
 388         struct gpio_fan_data *fan_data = cdev->devdata;
 389
 390         if (!fan_data)
 391                 return -EINVAL;
 392
 393         if (state >= fan_data->num_speed)
 394                 return -EINVAL;
 395
 396         set_fan_speed(fan_data, state);
 397         return 0;
 398 }
 399
 400 static const struct thermal_cooling_device_ops gpio_fan_cool_ops = {
 401         .get_max_state = gpio_fan_get_max_state,
 402         .get_cur_state = gpio_fan_get_cur_state,
 403         .set_cur_state = gpio_fan_set_cur_state,
 404 };
 405
 406 /*
 407  * Translate OpenFirmware node properties into platform_data
 408  */
 409 static int gpio_fan_get_of_data(struct gpio_fan_data *fan_data)
 410 {
 411         struct gpio_fan_speed *speed;
 412         struct device *dev = fan_data->dev;
 413         struct device_node *np = dev->of_node;
 414         struct gpio_desc **gpios;
 415         unsigned i;
 416         u32 u;
 417         struct property *prop;
 418         const __be32 *p;
 419
 420         /* Alarm GPIO if one exists */
 421         fan_data->alarm_gpio = devm_gpiod_get_optional(dev, "alarm", GPIOD_IN);
 422         if (IS_ERR(fan_data->alarm_gpio))
 423                 return PTR_ERR(fan_data->alarm_gpio);
 424
 425         /* Fill GPIO pin array */
 426         fan_data->num_gpios = gpiod_count(dev, NULL);
 427         if (fan_data->num_gpios <= 0) {
 428                 if (fan_data->alarm_gpio)
 429                         return 0;
 430                 dev_err(dev, "DT properties empty / missing");
 431                 return -ENODEV;
 432         }
 433         gpios = devm_kcalloc(dev,
 434                              fan_data->num_gpios, sizeof(struct gpio_desc *),
 435                              GFP_KERNEL);
 436         if (!gpios)
 437                 return -ENOMEM;
 438         for (i = 0; i < fan_data->num_gpios; i++) {
 439                 gpios[i] = devm_gpiod_get_index(dev, NULL, i, GPIOD_ASIS);
 440                 if (IS_ERR(gpios[i]))
 441                         return PTR_ERR(gpios[i]);
 442         }
 443         fan_data->gpios = gpios;
 444
 445         /* Get number of RPM/ctrl_val pairs in speed map */
 446         prop = of_find_property(np, "gpio-fan,speed-map", &i);
 447         if (!prop) {
 448                 dev_err(dev, "gpio-fan,speed-map DT property missing");
 449                 return -ENODEV;
 450         }
 451         i = i / sizeof(u32);
 452         if (i == 0 || i & 1) {
 453                 dev_err(dev, "gpio-fan,speed-map contains zero/odd number of entries");
 454                 return -ENODEV;
 455         }
 456         fan_data->num_speed = i / 2;
 457
 458         /*
 459          * Populate speed map
 460          * Speed map is in the form <RPM ctrl_val RPM ctrl_val ...>
 461          * this needs splitting into pairs to create gpio_fan_speed structs
 462          */
 463         speed = devm_kcalloc(dev,
 464                         fan_data->num_speed, sizeof(struct gpio_fan_speed),
 465                         GFP_KERNEL);
 466         if (!speed)
 467                 return -ENOMEM;
 468         p = NULL;
 469         for (i = 0; i < fan_data->num_speed; i++) {
 470                 p = of_prop_next_u32(prop, p, &u);
 471                 if (!p)
 472                         return -ENODEV;
 473                 speed[i].rpm = u;
 474                 p = of_prop_next_u32(prop, p, &u);
 475                 if (!p)
 476                         return -ENODEV;
 477                 speed[i].ctrl_val = u;
 478         }
 479         fan_data->speed = speed;
 480
 481         return 0;
 482 }
 483
 484 static const struct of_device_id of_gpio_fan_match[] = {
 485         { .compatible = "gpio-fan", },
 486         {},
 487 };
 488 MODULE_DEVICE_TABLE(of, of_gpio_fan_match);
 489
 490 static void gpio_fan_stop(void *data)
 491 {
 492         set_fan_speed(data, 0);
 493 }
 494
 495 static int gpio_fan_probe(struct platform_device *pdev)
 496 {
 497         int err;
 498         struct gpio_fan_data *fan_data;
 499         struct device *dev = &pdev->dev;
 500         struct device_node *np = dev->of_node;
 501
 502         fan_data = devm_kzalloc(dev, sizeof(struct gpio_fan_data),
 503                                 GFP_KERNEL);
 504         if (!fan_data)
 505                 return -ENOMEM;
 506
 507         fan_data->dev = dev;
 508         err = gpio_fan_get_of_data(fan_data);
 509         if (err)
 510                 return err;
 511
 512         platform_set_drvdata(pdev, fan_data);
 513         mutex_init(&fan_data->lock);
 514
 515         /* Configure control GPIOs if available. */
 516         if (fan_data->gpios && fan_data->num_gpios > 0) {
 517                 if (!fan_data->speed || fan_data->num_speed <= 1)
 518                         return -EINVAL;
 519                 err = fan_ctrl_init(fan_data);
 520                 if (err)
 521                         return err;
 522                 err = devm_add_action_or_reset(dev, gpio_fan_stop, fan_data);
 523                 if (err)
 524                         return err;
 525         }
 526
 527         /* Make this driver part of hwmon class. */
 528         fan_data->hwmon_dev =
 529                 devm_hwmon_device_register_with_groups(dev,
 530                                                        "gpio_fan", fan_data,
 531                                                        gpio_fan_groups);
 532         if (IS_ERR(fan_data->hwmon_dev))
 533                 return PTR_ERR(fan_data->hwmon_dev);
 534
 535         /* Configure alarm GPIO if available. */
 536         if (fan_data->alarm_gpio) {
 537                 err = fan_alarm_init(fan_data);
 538                 if (err)
 539                         return err;
 540         }
 541
 542         /* Optional cooling device register for Device tree platforms */
 543         fan_data->cdev = devm_thermal_of_cooling_device_register(dev, np,
 544                                 "gpio-fan", fan_data, &gpio_fan_cool_ops);
 545
 546         dev_info(dev, "GPIO fan initialized\n");
 547
 548         return 0;
 549 }
 550
 551 static void gpio_fan_shutdown(struct platform_device *pdev)
 552 {
 553         struct gpio_fan_data *fan_data = platform_get_drvdata(pdev);
 554
 555         if (fan_data->gpios)
 556                 set_fan_speed(fan_data, 0);
 557 }
 558
 559 static int gpio_fan_suspend(struct device *dev)
 560 {
 561         struct gpio_fan_data *fan_data = dev_get_drvdata(dev);
 562
 563         if (fan_data->gpios) {
 564                 fan_data->resume_speed = fan_data->speed_index;
 565                 set_fan_speed(fan_data, 0);
 566         }
 567
 568         return 0;
 569 }
 570
 571 static int gpio_fan_resume(struct device *dev)
 572 {
 573         struct gpio_fan_data *fan_data = dev_get_drvdata(dev);
 574
 575         if (fan_data->gpios)
 576                 set_fan_speed(fan_data, fan_data->resume_speed);
 577
 578         return 0;
 579 }
 580
 581 static DEFINE_SIMPLE_DEV_PM_OPS(gpio_fan_pm, gpio_fan_suspend, gpio_fan_resume);
 582
 583 static struct platform_driver gpio_fan_driver = {
 584         .probe          = gpio_fan_probe,
 585         .shutdown       = gpio_fan_shutdown,
 586         .driver = {
 587                 .name   = "gpio-fan",
 588                 .pm     = pm_sleep_ptr(&gpio_fan_pm),
 589                 .of_match_table = of_match_ptr(of_gpio_fan_match),
 590         },
 591 };
 592
 593 module_platform_driver(gpio_fan_driver);
 594
 595 MODULE_AUTHOR("Simon Guinot <sguinot@lacie.com>");
 596 MODULE_DESCRIPTION("GPIO FAN driver");
 597 MODULE_LICENSE("GPL");
 598 MODULE_ALIAS("platform:gpio-fan");