Lines Matching refs:fan_data
53 struct gpio_fan_data *fan_data =
56 sysfs_notify(&fan_data->hwmon_dev->kobj, NULL, "fan1_alarm");
57 kobject_uevent(&fan_data->hwmon_dev->kobj, KOBJ_CHANGE);
62 struct gpio_fan_data *fan_data = dev_id;
64 schedule_work(&fan_data->alarm_work);
72 struct gpio_fan_data *fan_data = dev_get_drvdata(dev);
75 gpiod_get_value_cansleep(fan_data->alarm_gpio));
80 static int fan_alarm_init(struct gpio_fan_data *fan_data)
83 struct device *dev = fan_data->dev;
89 alarm_irq = gpiod_to_irq(fan_data->alarm_gpio);
93 INIT_WORK(&fan_data->alarm_work, fan_alarm_notify);
96 IRQF_SHARED, "GPIO fan alarm", fan_data);
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)
108 for (i = 0; i < fan_data->num_gpios; i++)
109 gpiod_set_value_cansleep(fan_data->gpios[i],
113 static int __get_fan_ctrl(struct gpio_fan_data *fan_data)
118 for (i = 0; i < fan_data->num_gpios; i++) {
121 value = gpiod_get_value_cansleep(fan_data->gpios[i]);
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)
130 if (fan_data->speed_index == speed_index)
133 __set_fan_ctrl(fan_data, fan_data->speed[speed_index].ctrl_val);
134 fan_data->speed_index = speed_index;
137 static int get_fan_speed_index(struct gpio_fan_data *fan_data)
139 int ctrl_val = __get_fan_ctrl(fan_data);
142 for (i = 0; i < fan_data->num_speed; i++)
143 if (fan_data->speed[i].ctrl_val == ctrl_val)
146 dev_warn(fan_data->dev,
152 static int rpm_to_speed_index(struct gpio_fan_data *fan_data, unsigned long rpm)
154 struct gpio_fan_speed *speed = fan_data->speed;
157 for (i = 0; i < fan_data->num_speed; i++)
161 return fan_data->num_speed - 1;
167 struct gpio_fan_data *fan_data = dev_get_drvdata(dev);
168 u8 pwm = fan_data->speed_index * 255 / (fan_data->num_speed - 1);
176 struct gpio_fan_data *fan_data = dev_get_drvdata(dev);
184 mutex_lock(&fan_data->lock);
186 if (!fan_data->pwm_enable) {
191 speed_index = DIV_ROUND_UP(pwm * (fan_data->num_speed - 1), 255);
192 set_fan_speed(fan_data, speed_index);
195 mutex_unlock(&fan_data->lock);
203 struct gpio_fan_data *fan_data = dev_get_drvdata(dev);
205 return sprintf(buf, "%d\n", fan_data->pwm_enable);
212 struct gpio_fan_data *fan_data = dev_get_drvdata(dev);
218 if (fan_data->pwm_enable == val)
221 mutex_lock(&fan_data->lock);
223 fan_data->pwm_enable = val;
227 set_fan_speed(fan_data, fan_data->num_speed - 1);
229 mutex_unlock(&fan_data->lock);
243 struct gpio_fan_data *fan_data = dev_get_drvdata(dev);
245 return sprintf(buf, "%d\n", fan_data->speed[0].rpm);
251 struct gpio_fan_data *fan_data = dev_get_drvdata(dev);
254 fan_data->speed[fan_data->num_speed - 1].rpm);
260 struct gpio_fan_data *fan_data = dev_get_drvdata(dev);
262 return sprintf(buf, "%d\n", fan_data->speed[fan_data->speed_index].rpm);
268 struct gpio_fan_data *fan_data = dev_get_drvdata(dev);
275 mutex_lock(&fan_data->lock);
277 if (!fan_data->pwm_enable) {
282 set_fan_speed(fan_data, rpm_to_speed_index(fan_data, rpm));
285 mutex_unlock(&fan_data->lock);
334 static int fan_ctrl_init(struct gpio_fan_data *fan_data)
336 int num_gpios = fan_data->num_gpios;
337 struct gpio_desc **gpios = fan_data->gpios;
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;
364 struct gpio_fan_data *fan_data = cdev->devdata;
366 if (!fan_data)
369 *state = fan_data->num_speed - 1;
376 struct gpio_fan_data *fan_data = cdev->devdata;
378 if (!fan_data)
381 *state = fan_data->speed_index;
388 struct gpio_fan_data *fan_data = cdev->devdata;
390 if (!fan_data)
393 if (state >= fan_data->num_speed)
396 set_fan_speed(fan_data, state);
409 static int gpio_fan_get_of_data(struct gpio_fan_data *fan_data)
412 struct device *dev = fan_data->dev;
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);
426 fan_data->num_gpios = gpiod_count(dev, NULL);
427 if (fan_data->num_gpios <= 0) {
428 if (fan_data->alarm_gpio)
434 fan_data->num_gpios, sizeof(struct gpio_desc *),
438 for (i = 0; i < fan_data->num_gpios; i++) {
443 fan_data->gpios = gpios;
456 fan_data->num_speed = i / 2;
464 fan_data->num_speed, sizeof(struct gpio_fan_speed),
469 for (i = 0; i < fan_data->num_speed; i++) {
479 fan_data->speed = speed;
498 struct gpio_fan_data *fan_data;
502 fan_data = devm_kzalloc(dev, sizeof(struct gpio_fan_data),
504 if (!fan_data)
507 fan_data->dev = dev;
508 err = gpio_fan_get_of_data(fan_data);
512 platform_set_drvdata(pdev, fan_data);
513 mutex_init(&fan_data->lock);
516 if (fan_data->gpios && fan_data->num_gpios > 0) {
517 if (!fan_data->speed || fan_data->num_speed <= 1)
519 err = fan_ctrl_init(fan_data);
522 err = devm_add_action_or_reset(dev, gpio_fan_stop, fan_data);
528 fan_data->hwmon_dev =
530 "gpio_fan", fan_data,
532 if (IS_ERR(fan_data->hwmon_dev))
533 return PTR_ERR(fan_data->hwmon_dev);
536 if (fan_data->alarm_gpio) {
537 err = fan_alarm_init(fan_data);
543 fan_data->cdev = devm_thermal_of_cooling_device_register(dev, np,
544 "gpio-fan", fan_data, &gpio_fan_cool_ops);
553 struct gpio_fan_data *fan_data = platform_get_drvdata(pdev);
555 if (fan_data->gpios)
556 set_fan_speed(fan_data, 0);
561 struct gpio_fan_data *fan_data = dev_get_drvdata(dev);
563 if (fan_data->gpios) {
564 fan_data->resume_speed = fan_data->speed_index;
565 set_fan_speed(fan_data, 0);
573 struct gpio_fan_data *fan_data = dev_get_drvdata(dev);
575 if (fan_data->gpios)
576 set_fan_speed(fan_data, fan_data->resume_speed);