Lines Matching refs:fan_data
54 struct gpio_fan_data *fan_data =
57 sysfs_notify(&fan_data->hwmon_dev->kobj, NULL, "fan1_alarm");
58 kobject_uevent(&fan_data->hwmon_dev->kobj, KOBJ_CHANGE);
63 struct gpio_fan_data *fan_data = dev_id;
65 schedule_work(&fan_data->alarm_work);
73 struct gpio_fan_data *fan_data = dev_get_drvdata(dev);
76 gpiod_get_value_cansleep(fan_data->alarm_gpio));
81 static int fan_alarm_init(struct gpio_fan_data *fan_data)
84 struct device *dev = fan_data->dev;
90 alarm_irq = gpiod_to_irq(fan_data->alarm_gpio);
94 INIT_WORK(&fan_data->alarm_work, fan_alarm_notify);
97 IRQF_SHARED, "GPIO fan alarm", fan_data);
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)
109 for (i = 0; i < fan_data->num_gpios; i++)
110 gpiod_set_value_cansleep(fan_data->gpios[i],
114 static int __get_fan_ctrl(struct gpio_fan_data *fan_data)
119 for (i = 0; i < fan_data->num_gpios; i++) {
122 value = gpiod_get_value_cansleep(fan_data->gpios[i]);
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)
131 if (fan_data->speed_index == speed_index)
134 __set_fan_ctrl(fan_data, fan_data->speed[speed_index].ctrl_val);
135 fan_data->speed_index = speed_index;
138 static int get_fan_speed_index(struct gpio_fan_data *fan_data)
140 int ctrl_val = __get_fan_ctrl(fan_data);
143 for (i = 0; i < fan_data->num_speed; i++)
144 if (fan_data->speed[i].ctrl_val == ctrl_val)
147 dev_warn(fan_data->dev,
153 static int rpm_to_speed_index(struct gpio_fan_data *fan_data, unsigned long rpm)
155 struct gpio_fan_speed *speed = fan_data->speed;
158 for (i = 0; i < fan_data->num_speed; i++)
162 return fan_data->num_speed - 1;
168 struct gpio_fan_data *fan_data = dev_get_drvdata(dev);
169 u8 pwm = fan_data->speed_index * 255 / (fan_data->num_speed - 1);
177 struct gpio_fan_data *fan_data = dev_get_drvdata(dev);
185 mutex_lock(&fan_data->lock);
187 if (!fan_data->pwm_enable) {
192 speed_index = DIV_ROUND_UP(pwm * (fan_data->num_speed - 1), 255);
193 set_fan_speed(fan_data, speed_index);
196 mutex_unlock(&fan_data->lock);
204 struct gpio_fan_data *fan_data = dev_get_drvdata(dev);
206 return sprintf(buf, "%d\n", fan_data->pwm_enable);
213 struct gpio_fan_data *fan_data = dev_get_drvdata(dev);
219 if (fan_data->pwm_enable == val)
222 mutex_lock(&fan_data->lock);
224 fan_data->pwm_enable = val;
228 set_fan_speed(fan_data, fan_data->num_speed - 1);
230 mutex_unlock(&fan_data->lock);
244 struct gpio_fan_data *fan_data = dev_get_drvdata(dev);
246 return sprintf(buf, "%d\n", fan_data->speed[0].rpm);
252 struct gpio_fan_data *fan_data = dev_get_drvdata(dev);
255 fan_data->speed[fan_data->num_speed - 1].rpm);
261 struct gpio_fan_data *fan_data = dev_get_drvdata(dev);
263 return sprintf(buf, "%d\n", fan_data->speed[fan_data->speed_index].rpm);
269 struct gpio_fan_data *fan_data = dev_get_drvdata(dev);
276 mutex_lock(&fan_data->lock);
278 if (!fan_data->pwm_enable) {
283 set_fan_speed(fan_data, rpm_to_speed_index(fan_data, rpm));
286 mutex_unlock(&fan_data->lock);
335 static int fan_ctrl_init(struct gpio_fan_data *fan_data)
337 int num_gpios = fan_data->num_gpios;
338 struct gpio_desc **gpios = fan_data->gpios;
354 fan_data->pwm_enable = true; /* Enable manual fan speed control. */
355 fan_data->speed_index = get_fan_speed_index(fan_data);
356 if (fan_data->speed_index < 0)
357 return fan_data->speed_index;
365 struct gpio_fan_data *fan_data = cdev->devdata;
367 if (!fan_data)
370 *state = fan_data->num_speed - 1;
377 struct gpio_fan_data *fan_data = cdev->devdata;
379 if (!fan_data)
382 *state = fan_data->speed_index;
389 struct gpio_fan_data *fan_data = cdev->devdata;
391 if (!fan_data)
394 if (state >= fan_data->num_speed)
397 set_fan_speed(fan_data, state);
410 static int gpio_fan_get_of_data(struct gpio_fan_data *fan_data)
413 struct device *dev = fan_data->dev;
422 fan_data->alarm_gpio = devm_gpiod_get_optional(dev, "alarm", GPIOD_IN);
423 if (IS_ERR(fan_data->alarm_gpio))
424 return PTR_ERR(fan_data->alarm_gpio);
427 fan_data->num_gpios = gpiod_count(dev, NULL);
428 if (fan_data->num_gpios <= 0) {
429 if (fan_data->alarm_gpio)
435 fan_data->num_gpios, sizeof(struct gpio_desc *),
439 for (i = 0; i < fan_data->num_gpios; i++) {
444 fan_data->gpios = gpios;
457 fan_data->num_speed = i / 2;
465 fan_data->num_speed, sizeof(struct gpio_fan_speed),
470 for (i = 0; i < fan_data->num_speed; i++) {
480 fan_data->speed = speed;
499 struct gpio_fan_data *fan_data;
503 fan_data = devm_kzalloc(dev, sizeof(struct gpio_fan_data),
505 if (!fan_data)
508 fan_data->dev = dev;
509 err = gpio_fan_get_of_data(fan_data);
513 platform_set_drvdata(pdev, fan_data);
514 mutex_init(&fan_data->lock);
517 if (fan_data->gpios && fan_data->num_gpios > 0) {
518 if (!fan_data->speed || fan_data->num_speed <= 1)
520 err = fan_ctrl_init(fan_data);
523 err = devm_add_action_or_reset(dev, gpio_fan_stop, fan_data);
529 fan_data->hwmon_dev =
531 "gpio_fan", fan_data,
533 if (IS_ERR(fan_data->hwmon_dev))
534 return PTR_ERR(fan_data->hwmon_dev);
537 if (fan_data->alarm_gpio) {
538 err = fan_alarm_init(fan_data);
544 fan_data->cdev = devm_thermal_of_cooling_device_register(dev, np,
545 "gpio-fan", fan_data, &gpio_fan_cool_ops);
554 struct gpio_fan_data *fan_data = platform_get_drvdata(pdev);
556 if (fan_data->gpios)
557 set_fan_speed(fan_data, 0);
563 struct gpio_fan_data *fan_data = dev_get_drvdata(dev);
565 if (fan_data->gpios) {
566 fan_data->resume_speed = fan_data->speed_index;
567 set_fan_speed(fan_data, 0);
575 struct gpio_fan_data *fan_data = dev_get_drvdata(dev);
577 if (fan_data->gpios)
578 set_fan_speed(fan_data, fan_data->resume_speed);