Lines Matching +full:int +full:- +full:gpios
1 // SPDX-License-Identifier: GPL-2.0-or-later
3 * gpio-fan.c - Hwmon driver for fans connected to GPIO lines.
25 int rpm;
26 int ctrl_val;
34 struct mutex lock; /* lock GPIOs operations. */
35 int num_gpios;
36 struct gpio_desc **gpios; member
37 int num_speed;
39 int speed_index;
41 int resume_speed;
57 sysfs_notify(&fan_data->hwmon_dev->kobj, NULL, "fan1_alarm"); in fan_alarm_notify()
58 kobject_uevent(&fan_data->hwmon_dev->kobj, KOBJ_CHANGE); in fan_alarm_notify()
61 static irqreturn_t fan_alarm_irq_handler(int irq, void *dev_id) in fan_alarm_irq_handler()
65 schedule_work(&fan_data->alarm_work); in fan_alarm_irq_handler()
76 gpiod_get_value_cansleep(fan_data->alarm_gpio)); in fan1_alarm_show()
81 static int fan_alarm_init(struct gpio_fan_data *fan_data) in fan_alarm_init()
83 int alarm_irq; in fan_alarm_init()
84 struct device *dev = fan_data->dev; in fan_alarm_init()
90 alarm_irq = gpiod_to_irq(fan_data->alarm_gpio); in fan_alarm_init()
94 INIT_WORK(&fan_data->alarm_work, fan_alarm_notify); in fan_alarm_init()
101 * Control GPIOs.
104 /* Must be called with fan_data->lock held, except during initialization. */
105 static void __set_fan_ctrl(struct gpio_fan_data *fan_data, int ctrl_val) in __set_fan_ctrl()
107 int i; in __set_fan_ctrl()
109 for (i = 0; i < fan_data->num_gpios; i++) in __set_fan_ctrl()
110 gpiod_set_value_cansleep(fan_data->gpios[i], in __set_fan_ctrl()
114 static int __get_fan_ctrl(struct gpio_fan_data *fan_data) in __get_fan_ctrl()
116 int i; in __get_fan_ctrl()
117 int ctrl_val = 0; in __get_fan_ctrl()
119 for (i = 0; i < fan_data->num_gpios; i++) { in __get_fan_ctrl()
120 int value; in __get_fan_ctrl()
122 value = gpiod_get_value_cansleep(fan_data->gpios[i]); in __get_fan_ctrl()
128 /* Must be called with fan_data->lock held, except during initialization. */
129 static void set_fan_speed(struct gpio_fan_data *fan_data, int speed_index) in set_fan_speed()
131 if (fan_data->speed_index == speed_index) in set_fan_speed()
134 __set_fan_ctrl(fan_data, fan_data->speed[speed_index].ctrl_val); in set_fan_speed()
135 fan_data->speed_index = speed_index; in set_fan_speed()
138 static int get_fan_speed_index(struct gpio_fan_data *fan_data) in get_fan_speed_index()
140 int ctrl_val = __get_fan_ctrl(fan_data); in get_fan_speed_index()
141 int i; in get_fan_speed_index()
143 for (i = 0; i < fan_data->num_speed; i++) in get_fan_speed_index()
144 if (fan_data->speed[i].ctrl_val == ctrl_val) in get_fan_speed_index()
147 dev_warn(fan_data->dev, in get_fan_speed_index()
150 return -ENODEV; in get_fan_speed_index()
153 static int rpm_to_speed_index(struct gpio_fan_data *fan_data, unsigned long rpm) in rpm_to_speed_index()
155 struct gpio_fan_speed *speed = fan_data->speed; in rpm_to_speed_index()
156 int i; in rpm_to_speed_index()
158 for (i = 0; i < fan_data->num_speed; i++) in rpm_to_speed_index()
162 return fan_data->num_speed - 1; in rpm_to_speed_index()
169 u8 pwm = fan_data->speed_index * 255 / (fan_data->num_speed - 1); in pwm1_show()
179 int speed_index; in pwm1_store()
180 int ret = count; in pwm1_store()
183 return -EINVAL; in pwm1_store()
185 mutex_lock(&fan_data->lock); in pwm1_store()
187 if (!fan_data->pwm_enable) { in pwm1_store()
188 ret = -EPERM; in pwm1_store()
192 speed_index = DIV_ROUND_UP(pwm * (fan_data->num_speed - 1), 255); in pwm1_store()
196 mutex_unlock(&fan_data->lock); in pwm1_store()
206 return sprintf(buf, "%d\n", fan_data->pwm_enable); in pwm1_enable_show()
217 return -EINVAL; in pwm1_enable_store()
219 if (fan_data->pwm_enable == val) in pwm1_enable_store()
222 mutex_lock(&fan_data->lock); in pwm1_enable_store()
224 fan_data->pwm_enable = val; in pwm1_enable_store()
228 set_fan_speed(fan_data, fan_data->num_speed - 1); in pwm1_enable_store()
230 mutex_unlock(&fan_data->lock); in pwm1_enable_store()
246 return sprintf(buf, "%d\n", fan_data->speed[0].rpm); in fan1_min_show()
255 fan_data->speed[fan_data->num_speed - 1].rpm); in fan1_max_show()
263 return sprintf(buf, "%d\n", fan_data->speed[fan_data->speed_index].rpm); in fan1_input_show()
271 int ret = count; in set_rpm()
274 return -EINVAL; in set_rpm()
276 mutex_lock(&fan_data->lock); in set_rpm()
278 if (!fan_data->pwm_enable) { in set_rpm()
279 ret = -EPERM; in set_rpm()
286 mutex_unlock(&fan_data->lock); in set_rpm()
300 struct attribute *attr, int index) in gpio_fan_is_visible()
305 if (index == 0 && !data->alarm_gpio) in gpio_fan_is_visible()
307 if (index > 0 && !data->gpios) in gpio_fan_is_visible()
310 return attr->mode; in gpio_fan_is_visible()
335 static int fan_ctrl_init(struct gpio_fan_data *fan_data) in fan_ctrl_init()
337 int num_gpios = fan_data->num_gpios; in fan_ctrl_init()
338 struct gpio_desc **gpios = fan_data->gpios; in fan_ctrl_init() local
339 int i, err; in fan_ctrl_init()
348 err = gpiod_direction_output(gpios[i], in fan_ctrl_init()
349 gpiod_get_value_cansleep(gpios[i])); in fan_ctrl_init()
354 fan_data->pwm_enable = true; /* Enable manual fan speed control. */ in fan_ctrl_init()
355 fan_data->speed_index = get_fan_speed_index(fan_data); in fan_ctrl_init()
356 if (fan_data->speed_index < 0) in fan_ctrl_init()
357 return fan_data->speed_index; in fan_ctrl_init()
362 static int gpio_fan_get_max_state(struct thermal_cooling_device *cdev, in gpio_fan_get_max_state()
365 struct gpio_fan_data *fan_data = cdev->devdata; in gpio_fan_get_max_state()
368 return -EINVAL; in gpio_fan_get_max_state()
370 *state = fan_data->num_speed - 1; in gpio_fan_get_max_state()
374 static int gpio_fan_get_cur_state(struct thermal_cooling_device *cdev, in gpio_fan_get_cur_state()
377 struct gpio_fan_data *fan_data = cdev->devdata; in gpio_fan_get_cur_state()
380 return -EINVAL; in gpio_fan_get_cur_state()
382 *state = fan_data->speed_index; in gpio_fan_get_cur_state()
386 static int gpio_fan_set_cur_state(struct thermal_cooling_device *cdev, in gpio_fan_set_cur_state()
389 struct gpio_fan_data *fan_data = cdev->devdata; in gpio_fan_set_cur_state()
392 return -EINVAL; in gpio_fan_set_cur_state()
407 static int gpio_fan_get_of_data(struct gpio_fan_data *fan_data) in gpio_fan_get_of_data()
410 struct device *dev = fan_data->dev; in gpio_fan_get_of_data()
411 struct device_node *np = dev->of_node; in gpio_fan_get_of_data()
412 struct gpio_desc **gpios; in gpio_fan_get_of_data() local
419 fan_data->alarm_gpio = devm_gpiod_get_optional(dev, "alarm", GPIOD_IN); in gpio_fan_get_of_data()
420 if (IS_ERR(fan_data->alarm_gpio)) in gpio_fan_get_of_data()
421 return PTR_ERR(fan_data->alarm_gpio); in gpio_fan_get_of_data()
424 fan_data->num_gpios = gpiod_count(dev, NULL); in gpio_fan_get_of_data()
425 if (fan_data->num_gpios <= 0) { in gpio_fan_get_of_data()
426 if (fan_data->alarm_gpio) in gpio_fan_get_of_data()
429 return -ENODEV; in gpio_fan_get_of_data()
431 gpios = devm_kcalloc(dev, in gpio_fan_get_of_data()
432 fan_data->num_gpios, sizeof(struct gpio_desc *), in gpio_fan_get_of_data()
434 if (!gpios) in gpio_fan_get_of_data()
435 return -ENOMEM; in gpio_fan_get_of_data()
436 for (i = 0; i < fan_data->num_gpios; i++) { in gpio_fan_get_of_data()
437 gpios[i] = devm_gpiod_get_index(dev, NULL, i, GPIOD_ASIS); in gpio_fan_get_of_data()
438 if (IS_ERR(gpios[i])) in gpio_fan_get_of_data()
439 return PTR_ERR(gpios[i]); in gpio_fan_get_of_data()
441 fan_data->gpios = gpios; in gpio_fan_get_of_data()
444 prop = of_find_property(np, "gpio-fan,speed-map", &i); in gpio_fan_get_of_data()
446 dev_err(dev, "gpio-fan,speed-map DT property missing"); in gpio_fan_get_of_data()
447 return -ENODEV; in gpio_fan_get_of_data()
451 dev_err(dev, "gpio-fan,speed-map contains zero/odd number of entries"); in gpio_fan_get_of_data()
452 return -ENODEV; in gpio_fan_get_of_data()
454 fan_data->num_speed = i / 2; in gpio_fan_get_of_data()
462 fan_data->num_speed, sizeof(struct gpio_fan_speed), in gpio_fan_get_of_data()
465 return -ENOMEM; in gpio_fan_get_of_data()
467 for (i = 0; i < fan_data->num_speed; i++) { in gpio_fan_get_of_data()
470 return -ENODEV; in gpio_fan_get_of_data()
474 return -ENODEV; in gpio_fan_get_of_data()
477 fan_data->speed = speed; in gpio_fan_get_of_data()
483 { .compatible = "gpio-fan", },
493 static int gpio_fan_probe(struct platform_device *pdev) in gpio_fan_probe()
495 int err; in gpio_fan_probe()
497 struct device *dev = &pdev->dev; in gpio_fan_probe()
498 struct device_node *np = dev->of_node; in gpio_fan_probe()
503 return -ENOMEM; in gpio_fan_probe()
505 fan_data->dev = dev; in gpio_fan_probe()
511 mutex_init(&fan_data->lock); in gpio_fan_probe()
513 /* Configure control GPIOs if available. */ in gpio_fan_probe()
514 if (fan_data->gpios && fan_data->num_gpios > 0) { in gpio_fan_probe()
515 if (!fan_data->speed || fan_data->num_speed <= 1) in gpio_fan_probe()
516 return -EINVAL; in gpio_fan_probe()
526 fan_data->hwmon_dev = in gpio_fan_probe()
530 if (IS_ERR(fan_data->hwmon_dev)) in gpio_fan_probe()
531 return PTR_ERR(fan_data->hwmon_dev); in gpio_fan_probe()
534 if (fan_data->alarm_gpio) { in gpio_fan_probe()
541 fan_data->cdev = devm_thermal_of_cooling_device_register(dev, np, in gpio_fan_probe()
542 "gpio-fan", fan_data, &gpio_fan_cool_ops); in gpio_fan_probe()
553 if (fan_data->gpios) in gpio_fan_shutdown()
558 static int gpio_fan_suspend(struct device *dev) in gpio_fan_suspend()
562 if (fan_data->gpios) { in gpio_fan_suspend()
563 fan_data->resume_speed = fan_data->speed_index; in gpio_fan_suspend()
570 static int gpio_fan_resume(struct device *dev) in gpio_fan_resume()
574 if (fan_data->gpios) in gpio_fan_resume()
575 set_fan_speed(fan_data, fan_data->resume_speed); in gpio_fan_resume()
590 .name = "gpio-fan",
601 MODULE_ALIAS("platform:gpio-fan");