1 // SPDX-License-Identifier: GPL-2.0+
3  *  GPIO vibrator driver
7  *  Based on PWM vibrator driver:
14  *  Copyright (C) 2010, Lars-Peter Clausen <lars@metafoo.de>
17 #include <linux/gpio/consumer.h>
29 	struct gpio_desc *gpio;  member
37 static int gpio_vibrator_start(struct gpio_vibrator *vibrator)  in gpio_vibrator_start()  argument
39 	struct device *pdev = vibrator->input->dev.parent;  in gpio_vibrator_start()
42 	if (!vibrator->vcc_on) {  in gpio_vibrator_start()
43 		err = regulator_enable(vibrator->vcc);  in gpio_vibrator_start()
48 		vibrator->vcc_on = true;  in gpio_vibrator_start()
51 	gpiod_set_value_cansleep(vibrator->gpio, 1);  in gpio_vibrator_start()
56 static void gpio_vibrator_stop(struct gpio_vibrator *vibrator)  in gpio_vibrator_stop()  argument
58 	gpiod_set_value_cansleep(vibrator->gpio, 0);  in gpio_vibrator_stop()
60 	if (vibrator->vcc_on) {  in gpio_vibrator_stop()
61 		regulator_disable(vibrator->vcc);  in gpio_vibrator_stop()
62 		vibrator->vcc_on = false;  in gpio_vibrator_stop()
68 	struct gpio_vibrator *vibrator =  in gpio_vibrator_play_work()  local
71 	if (vibrator->running)  in gpio_vibrator_play_work()
72 		gpio_vibrator_start(vibrator);  in gpio_vibrator_play_work()
74 		gpio_vibrator_stop(vibrator);  in gpio_vibrator_play_work()
80 	struct gpio_vibrator *vibrator = input_get_drvdata(dev);  in gpio_vibrator_play_effect()  local
83 	level = effect->u.rumble.strong_magnitude;  in gpio_vibrator_play_effect()
85 		level = effect->u.rumble.weak_magnitude;  in gpio_vibrator_play_effect()
87 	vibrator->running = level;  in gpio_vibrator_play_effect()
88 	schedule_work(&vibrator->play_work);  in gpio_vibrator_play_effect()
95 	struct gpio_vibrator *vibrator = input_get_drvdata(input);  in gpio_vibrator_close()  local
97 	cancel_work_sync(&vibrator->play_work);  in gpio_vibrator_close()
98 	gpio_vibrator_stop(vibrator);  in gpio_vibrator_close()
99 	vibrator->running = false;  in gpio_vibrator_close()
104 	struct gpio_vibrator *vibrator;  in gpio_vibrator_probe()  local
107 	vibrator = devm_kzalloc(&pdev->dev, sizeof(*vibrator), GFP_KERNEL);  in gpio_vibrator_probe()
108 	if (!vibrator)  in gpio_vibrator_probe()
109 		return -ENOMEM;  in gpio_vibrator_probe()
111 	vibrator->input = devm_input_allocate_device(&pdev->dev);  in gpio_vibrator_probe()
112 	if (!vibrator->input)  in gpio_vibrator_probe()
113 		return -ENOMEM;  in gpio_vibrator_probe()
115 	vibrator->vcc = devm_regulator_get(&pdev->dev, "vcc");  in gpio_vibrator_probe()
116 	err = PTR_ERR_OR_ZERO(vibrator->vcc);  in gpio_vibrator_probe()
118 		if (err != -EPROBE_DEFER)  in gpio_vibrator_probe()
119 			dev_err(&pdev->dev, "Failed to request regulator: %d\n",  in gpio_vibrator_probe()
124 	vibrator->gpio = devm_gpiod_get(&pdev->dev, "enable", GPIOD_OUT_LOW);  in gpio_vibrator_probe()
125 	err = PTR_ERR_OR_ZERO(vibrator->gpio);  in gpio_vibrator_probe()
127 		if (err != -EPROBE_DEFER)  in gpio_vibrator_probe()
128 			dev_err(&pdev->dev, "Failed to request main gpio: %d\n",  in gpio_vibrator_probe()
133 	INIT_WORK(&vibrator->play_work, gpio_vibrator_play_work);  in gpio_vibrator_probe()
135 	vibrator->input->name = "gpio-vibrator";  in gpio_vibrator_probe()
136 	vibrator->input->id.bustype = BUS_HOST;  in gpio_vibrator_probe()
137 	vibrator->input->close = gpio_vibrator_close;  in gpio_vibrator_probe()
139 	input_set_drvdata(vibrator->input, vibrator);  in gpio_vibrator_probe()
140 	input_set_capability(vibrator->input, EV_FF, FF_RUMBLE);  in gpio_vibrator_probe()
142 	err = input_ff_create_memless(vibrator->input, NULL,  in gpio_vibrator_probe()
145 		dev_err(&pdev->dev, "Couldn't create FF dev: %d\n", err);  in gpio_vibrator_probe()
149 	err = input_register_device(vibrator->input);  in gpio_vibrator_probe()
151 		dev_err(&pdev->dev, "Couldn't register input dev: %d\n", err);  in gpio_vibrator_probe()
155 	platform_set_drvdata(pdev, vibrator);  in gpio_vibrator_probe()
163 	struct gpio_vibrator *vibrator = platform_get_drvdata(pdev);  in gpio_vibrator_suspend()  local
165 	cancel_work_sync(&vibrator->play_work);  in gpio_vibrator_suspend()
166 	if (vibrator->running)  in gpio_vibrator_suspend()
167 		gpio_vibrator_stop(vibrator);  in gpio_vibrator_suspend()
175 	struct gpio_vibrator *vibrator = platform_get_drvdata(pdev);  in gpio_vibrator_resume()  local
177 	if (vibrator->running)  in gpio_vibrator_resume()
178 		gpio_vibrator_start(vibrator);  in gpio_vibrator_resume()
188 	{ .compatible = "gpio-vibrator" },
197 		.name	= "gpio-vibrator",
205 MODULE_DESCRIPTION("GPIO vibrator driver");
207 MODULE_ALIAS("platform:gpio-vibrator");