input/misc/gpio-vibra.c

3  *  GPIO vibrator driver
7  *  Based on PWM vibrator driver:
37 static int gpio_vibrator_start(struct gpio_vibrator *vibrator)
39 	struct device *pdev = vibrator->input->dev.parent;
42 	if (!vibrator->vcc_on) {
43 		err = regulator_enable(vibrator->vcc);
48 		vibrator->vcc_on = true;
51 	gpiod_set_value_cansleep(vibrator->gpio, 1);
56 static void gpio_vibrator_stop(struct gpio_vibrator *vibrator)
58 	gpiod_set_value_cansleep(vibrator->gpio, 0);
60 	if (vibrator->vcc_on) {
61 		regulator_disable(vibrator->vcc);
62 		vibrator->vcc_on = false;
68 	struct gpio_vibrator *vibrator =
71 	if (vibrator->running)
72 		gpio_vibrator_start(vibrator);
74 		gpio_vibrator_stop(vibrator);
80 	struct gpio_vibrator *vibrator = input_get_drvdata(dev);
87 	vibrator->running = level;
88 	schedule_work(&vibrator->play_work);
95 	struct gpio_vibrator *vibrator = input_get_drvdata(input);
97 	cancel_work_sync(&vibrator->play_work);
98 	gpio_vibrator_stop(vibrator);
99 	vibrator->running = false;
104 	struct gpio_vibrator *vibrator;
107 	vibrator = devm_kzalloc(&pdev->dev, sizeof(*vibrator), GFP_KERNEL);
108 	if (!vibrator)
111 	vibrator->input = devm_input_allocate_device(&pdev->dev);
112 	if (!vibrator->input)
115 	vibrator->vcc = devm_regulator_get(&pdev->dev, "vcc");
116 	if (IS_ERR(vibrator->vcc))
117 		return dev_err_probe(&pdev->dev, PTR_ERR(vibrator->vcc),
120 	vibrator->gpio = devm_gpiod_get(&pdev->dev, "enable", GPIOD_OUT_LOW);
121 	if (IS_ERR(vibrator->gpio))
122 		return dev_err_probe(&pdev->dev, PTR_ERR(vibrator->gpio),
125 	INIT_WORK(&vibrator->play_work, gpio_vibrator_play_work);
127 	vibrator->input->name = "gpio-vibrator";
128 	vibrator->input->id.bustype = BUS_HOST;
129 	vibrator->input->close = gpio_vibrator_close;
131 	input_set_drvdata(vibrator->input, vibrator);
132 	input_set_capability(vibrator->input, EV_FF, FF_RUMBLE);
134 	err = input_ff_create_memless(vibrator->input, NULL,
141 	err = input_register_device(vibrator->input);
147 	platform_set_drvdata(pdev, vibrator);
155 	struct gpio_vibrator *vibrator = platform_get_drvdata(pdev);
157 	cancel_work_sync(&vibrator->play_work);
158 	if (vibrator->running)
159 		gpio_vibrator_stop(vibrator);
167 	struct gpio_vibrator *vibrator = platform_get_drvdata(pdev);
169 	if (vibrator->running)
170 		gpio_vibrator_start(vibrator);
180 	{ .compatible = "gpio-vibrator" },
189 		.name	= "gpio-vibrator",
197 MODULE_DESCRIPTION("GPIO vibrator driver");
199 MODULE_ALIAS("platform:gpio-vibrator");