Lines Matching refs:fan_data
54 struct gpio_fan_data *fan_data = in fan_alarm_notify() local
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()
63 struct gpio_fan_data *fan_data = dev_id; in fan_alarm_irq_handler() local
65 schedule_work(&fan_data->alarm_work); in fan_alarm_irq_handler()
73 struct gpio_fan_data *fan_data = dev_get_drvdata(dev); in fan1_alarm_show() local
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() argument
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()
97 IRQF_SHARED, "GPIO fan alarm", fan_data); in fan_alarm_init()
105 static void __set_fan_ctrl(struct gpio_fan_data *fan_data, int ctrl_val) in __set_fan_ctrl() argument
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() argument
119 for (i = 0; i < fan_data->num_gpios; i++) { in __get_fan_ctrl()
122 value = gpiod_get_value_cansleep(fan_data->gpios[i]); in __get_fan_ctrl()
129 static void set_fan_speed(struct gpio_fan_data *fan_data, int speed_index) in set_fan_speed() argument
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() argument
140 int ctrl_val = __get_fan_ctrl(fan_data); 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()
153 static int rpm_to_speed_index(struct gpio_fan_data *fan_data, unsigned long rpm) in rpm_to_speed_index() argument
155 struct gpio_fan_speed *speed = fan_data->speed; 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()
168 struct gpio_fan_data *fan_data = dev_get_drvdata(dev); in pwm1_show() local
169 u8 pwm = fan_data->speed_index * 255 / (fan_data->num_speed - 1); in pwm1_show()
177 struct gpio_fan_data *fan_data = dev_get_drvdata(dev); in pwm1_store() local
185 mutex_lock(&fan_data->lock); in pwm1_store()
187 if (!fan_data->pwm_enable) { in pwm1_store()
192 speed_index = DIV_ROUND_UP(pwm * (fan_data->num_speed - 1), 255); in pwm1_store()
193 set_fan_speed(fan_data, speed_index); in pwm1_store()
196 mutex_unlock(&fan_data->lock); in pwm1_store()
204 struct gpio_fan_data *fan_data = dev_get_drvdata(dev); in pwm1_enable_show() local
206 return sprintf(buf, "%d\n", fan_data->pwm_enable); in pwm1_enable_show()
213 struct gpio_fan_data *fan_data = dev_get_drvdata(dev); in pwm1_enable_store() local
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()
244 struct gpio_fan_data *fan_data = dev_get_drvdata(dev); in fan1_min_show() local
246 return sprintf(buf, "%d\n", fan_data->speed[0].rpm); in fan1_min_show()
252 struct gpio_fan_data *fan_data = dev_get_drvdata(dev); in fan1_max_show() local
255 fan_data->speed[fan_data->num_speed - 1].rpm); in fan1_max_show()
261 struct gpio_fan_data *fan_data = dev_get_drvdata(dev); in fan1_input_show() local
263 return sprintf(buf, "%d\n", fan_data->speed[fan_data->speed_index].rpm); in fan1_input_show()
269 struct gpio_fan_data *fan_data = dev_get_drvdata(dev); in set_rpm() local
276 mutex_lock(&fan_data->lock); in set_rpm()
278 if (!fan_data->pwm_enable) { in set_rpm()
283 set_fan_speed(fan_data, rpm_to_speed_index(fan_data, rpm)); in set_rpm()
286 mutex_unlock(&fan_data->lock); in set_rpm()
335 static int fan_ctrl_init(struct gpio_fan_data *fan_data) in fan_ctrl_init() argument
337 int num_gpios = fan_data->num_gpios; in fan_ctrl_init()
338 struct gpio_desc **gpios = fan_data->gpios; 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()
365 struct gpio_fan_data *fan_data = cdev->devdata; in gpio_fan_get_max_state() local
367 if (!fan_data) in gpio_fan_get_max_state()
370 *state = fan_data->num_speed - 1; in gpio_fan_get_max_state()
377 struct gpio_fan_data *fan_data = cdev->devdata; in gpio_fan_get_cur_state() local
379 if (!fan_data) in gpio_fan_get_cur_state()
382 *state = fan_data->speed_index; in gpio_fan_get_cur_state()
389 struct gpio_fan_data *fan_data = cdev->devdata; in gpio_fan_set_cur_state() local
391 if (!fan_data) in gpio_fan_set_cur_state()
394 if (state >= fan_data->num_speed) in gpio_fan_set_cur_state()
397 set_fan_speed(fan_data, state); in gpio_fan_set_cur_state()
410 static int gpio_fan_get_of_data(struct gpio_fan_data *fan_data) in gpio_fan_get_of_data() argument
413 struct device *dev = fan_data->dev; in gpio_fan_get_of_data()
422 fan_data->alarm_gpio = devm_gpiod_get_optional(dev, "alarm", GPIOD_IN); in gpio_fan_get_of_data()
423 if (IS_ERR(fan_data->alarm_gpio)) in gpio_fan_get_of_data()
424 return PTR_ERR(fan_data->alarm_gpio); in gpio_fan_get_of_data()
427 fan_data->num_gpios = gpiod_count(dev, NULL); in gpio_fan_get_of_data()
428 if (fan_data->num_gpios <= 0) { in gpio_fan_get_of_data()
429 if (fan_data->alarm_gpio) in gpio_fan_get_of_data()
435 fan_data->num_gpios, sizeof(struct gpio_desc *), in gpio_fan_get_of_data()
439 for (i = 0; i < fan_data->num_gpios; i++) { in gpio_fan_get_of_data()
444 fan_data->gpios = gpios; in gpio_fan_get_of_data()
457 fan_data->num_speed = i / 2; in gpio_fan_get_of_data()
465 fan_data->num_speed, sizeof(struct gpio_fan_speed), in gpio_fan_get_of_data()
470 for (i = 0; i < fan_data->num_speed; i++) { in gpio_fan_get_of_data()
480 fan_data->speed = speed; in gpio_fan_get_of_data()
499 struct gpio_fan_data *fan_data; in gpio_fan_probe() local
503 fan_data = devm_kzalloc(dev, sizeof(struct gpio_fan_data), in gpio_fan_probe()
505 if (!fan_data) in gpio_fan_probe()
508 fan_data->dev = dev; in gpio_fan_probe()
509 err = gpio_fan_get_of_data(fan_data); in gpio_fan_probe()
513 platform_set_drvdata(pdev, fan_data); in gpio_fan_probe()
514 mutex_init(&fan_data->lock); in gpio_fan_probe()
517 if (fan_data->gpios && fan_data->num_gpios > 0) { in gpio_fan_probe()
518 if (!fan_data->speed || fan_data->num_speed <= 1) in gpio_fan_probe()
520 err = fan_ctrl_init(fan_data); in gpio_fan_probe()
523 err = devm_add_action_or_reset(dev, gpio_fan_stop, fan_data); in gpio_fan_probe()
529 fan_data->hwmon_dev = in gpio_fan_probe()
531 "gpio_fan", fan_data, in gpio_fan_probe()
533 if (IS_ERR(fan_data->hwmon_dev)) in gpio_fan_probe()
534 return PTR_ERR(fan_data->hwmon_dev); in gpio_fan_probe()
537 if (fan_data->alarm_gpio) { in gpio_fan_probe()
538 err = fan_alarm_init(fan_data); in gpio_fan_probe()
544 fan_data->cdev = devm_thermal_of_cooling_device_register(dev, np, in gpio_fan_probe()
545 "gpio-fan", fan_data, &gpio_fan_cool_ops); in gpio_fan_probe()
554 struct gpio_fan_data *fan_data = platform_get_drvdata(pdev); in gpio_fan_shutdown() local
556 if (fan_data->gpios) in gpio_fan_shutdown()
557 set_fan_speed(fan_data, 0); in gpio_fan_shutdown()
563 struct gpio_fan_data *fan_data = dev_get_drvdata(dev); in gpio_fan_suspend() local
565 if (fan_data->gpios) { in gpio_fan_suspend()
566 fan_data->resume_speed = fan_data->speed_index; in gpio_fan_suspend()
567 set_fan_speed(fan_data, 0); in gpio_fan_suspend()
575 struct gpio_fan_data *fan_data = dev_get_drvdata(dev); in gpio_fan_resume() local
577 if (fan_data->gpios) in gpio_fan_resume()
578 set_fan_speed(fan_data, fan_data->resume_speed); in gpio_fan_resume()