Lines Matching +full:pwm +full:- +full:based
1 // SPDX-License-Identifier: GPL-2.0-or-later
3 * PWM vibrator driver
7 * Based on previous work from:
10 * Based on PWM beeper driver:
11 * Copyright (C) 2010, Lars-Peter Clausen <lars@metafoo.de>
20 #include <linux/pwm.h>
26 struct pwm_device *pwm; member
38 struct device *pdev = vibrator->input->dev.parent; in pwm_vibrator_start()
42 if (!vibrator->vcc_on) { in pwm_vibrator_start()
43 err = regulator_enable(vibrator->vcc); in pwm_vibrator_start()
48 vibrator->vcc_on = true; in pwm_vibrator_start()
51 pwm_get_state(vibrator->pwm, &state); in pwm_vibrator_start()
52 pwm_set_relative_duty_cycle(&state, vibrator->level, 0xffff); in pwm_vibrator_start()
55 err = pwm_apply_state(vibrator->pwm, &state); in pwm_vibrator_start()
57 dev_err(pdev, "failed to apply pwm state: %d", err); in pwm_vibrator_start()
61 if (vibrator->pwm_dir) { in pwm_vibrator_start()
62 pwm_get_state(vibrator->pwm_dir, &state); in pwm_vibrator_start()
63 state.duty_cycle = vibrator->direction_duty_cycle; in pwm_vibrator_start()
66 err = pwm_apply_state(vibrator->pwm_dir, &state); in pwm_vibrator_start()
68 dev_err(pdev, "failed to apply dir-pwm state: %d", err); in pwm_vibrator_start()
69 pwm_disable(vibrator->pwm); in pwm_vibrator_start()
79 if (vibrator->pwm_dir) in pwm_vibrator_stop()
80 pwm_disable(vibrator->pwm_dir); in pwm_vibrator_stop()
81 pwm_disable(vibrator->pwm); in pwm_vibrator_stop()
83 if (vibrator->vcc_on) { in pwm_vibrator_stop()
84 regulator_disable(vibrator->vcc); in pwm_vibrator_stop()
85 vibrator->vcc_on = false; in pwm_vibrator_stop()
94 if (vibrator->level) in pwm_vibrator_play_work()
105 vibrator->level = effect->u.rumble.strong_magnitude; in pwm_vibrator_play_effect()
106 if (!vibrator->level) in pwm_vibrator_play_effect()
107 vibrator->level = effect->u.rumble.weak_magnitude; in pwm_vibrator_play_effect()
109 schedule_work(&vibrator->play_work); in pwm_vibrator_play_effect()
118 cancel_work_sync(&vibrator->play_work); in pwm_vibrator_close()
128 vibrator = devm_kzalloc(&pdev->dev, sizeof(*vibrator), GFP_KERNEL); in pwm_vibrator_probe()
130 return -ENOMEM; in pwm_vibrator_probe()
132 vibrator->input = devm_input_allocate_device(&pdev->dev); in pwm_vibrator_probe()
133 if (!vibrator->input) in pwm_vibrator_probe()
134 return -ENOMEM; in pwm_vibrator_probe()
136 vibrator->vcc = devm_regulator_get(&pdev->dev, "vcc"); in pwm_vibrator_probe()
137 err = PTR_ERR_OR_ZERO(vibrator->vcc); in pwm_vibrator_probe()
139 if (err != -EPROBE_DEFER) in pwm_vibrator_probe()
140 dev_err(&pdev->dev, "Failed to request regulator: %d", in pwm_vibrator_probe()
145 vibrator->pwm = devm_pwm_get(&pdev->dev, "enable"); in pwm_vibrator_probe()
146 err = PTR_ERR_OR_ZERO(vibrator->pwm); in pwm_vibrator_probe()
148 if (err != -EPROBE_DEFER) in pwm_vibrator_probe()
149 dev_err(&pdev->dev, "Failed to request main pwm: %d", in pwm_vibrator_probe()
154 INIT_WORK(&vibrator->play_work, pwm_vibrator_play_work); in pwm_vibrator_probe()
156 /* Sync up PWM state and ensure it is off. */ in pwm_vibrator_probe()
157 pwm_init_state(vibrator->pwm, &state); in pwm_vibrator_probe()
159 err = pwm_apply_state(vibrator->pwm, &state); in pwm_vibrator_probe()
161 dev_err(&pdev->dev, "failed to apply initial PWM state: %d", in pwm_vibrator_probe()
166 vibrator->pwm_dir = devm_pwm_get(&pdev->dev, "direction"); in pwm_vibrator_probe()
167 err = PTR_ERR_OR_ZERO(vibrator->pwm_dir); in pwm_vibrator_probe()
170 /* Sync up PWM state and ensure it is off. */ in pwm_vibrator_probe()
171 pwm_init_state(vibrator->pwm_dir, &state); in pwm_vibrator_probe()
173 err = pwm_apply_state(vibrator->pwm_dir, &state); in pwm_vibrator_probe()
175 dev_err(&pdev->dev, "failed to apply initial PWM state: %d", in pwm_vibrator_probe()
180 vibrator->direction_duty_cycle = in pwm_vibrator_probe()
181 pwm_get_period(vibrator->pwm_dir) / 2; in pwm_vibrator_probe()
182 device_property_read_u32(&pdev->dev, "direction-duty-cycle-ns", in pwm_vibrator_probe()
183 &vibrator->direction_duty_cycle); in pwm_vibrator_probe()
186 case -ENODATA: in pwm_vibrator_probe()
187 /* Direction PWM is optional */ in pwm_vibrator_probe()
188 vibrator->pwm_dir = NULL; in pwm_vibrator_probe()
192 dev_err(&pdev->dev, "Failed to request direction pwm: %d", err); in pwm_vibrator_probe()
195 case -EPROBE_DEFER: in pwm_vibrator_probe()
199 vibrator->input->name = "pwm-vibrator"; in pwm_vibrator_probe()
200 vibrator->input->id.bustype = BUS_HOST; in pwm_vibrator_probe()
201 vibrator->input->dev.parent = &pdev->dev; in pwm_vibrator_probe()
202 vibrator->input->close = pwm_vibrator_close; in pwm_vibrator_probe()
204 input_set_drvdata(vibrator->input, vibrator); in pwm_vibrator_probe()
205 input_set_capability(vibrator->input, EV_FF, FF_RUMBLE); in pwm_vibrator_probe()
207 err = input_ff_create_memless(vibrator->input, NULL, in pwm_vibrator_probe()
210 dev_err(&pdev->dev, "Couldn't create FF dev: %d", err); in pwm_vibrator_probe()
214 err = input_register_device(vibrator->input); in pwm_vibrator_probe()
216 dev_err(&pdev->dev, "Couldn't register input dev: %d", err); in pwm_vibrator_probe()
229 cancel_work_sync(&vibrator->play_work); in pwm_vibrator_suspend()
230 if (vibrator->level) in pwm_vibrator_suspend()
240 if (vibrator->level) in pwm_vibrator_resume()
251 { .compatible = "pwm-vibrator" },
260 .name = "pwm-vibrator",
268 MODULE_DESCRIPTION("PWM vibrator driver");
270 MODULE_ALIAS("platform:pwm-vibrator");