1
2
3
4
5
6
7
8
9
10
11
12
13
14#include <linux/input.h>
15#include <linux/kernel.h>
16#include <linux/module.h>
17#include <linux/of_device.h>
18#include <linux/platform_device.h>
19#include <linux/property.h>
20#include <linux/pwm.h>
21#include <linux/regulator/consumer.h>
22#include <linux/slab.h>
23
24struct pwm_vibrator {
25 struct input_dev *input;
26 struct pwm_device *pwm;
27 struct pwm_device *pwm_dir;
28 struct regulator *vcc;
29
30 struct work_struct play_work;
31 u16 level;
32 u32 direction_duty_cycle;
33 bool vcc_on;
34};
35
36static int pwm_vibrator_start(struct pwm_vibrator *vibrator)
37{
38 struct device *pdev = vibrator->input->dev.parent;
39 struct pwm_state state;
40 int err;
41
42 if (!vibrator->vcc_on) {
43 err = regulator_enable(vibrator->vcc);
44 if (err) {
45 dev_err(pdev, "failed to enable regulator: %d", err);
46 return err;
47 }
48 vibrator->vcc_on = true;
49 }
50
51 pwm_get_state(vibrator->pwm, &state);
52 pwm_set_relative_duty_cycle(&state, vibrator->level, 0xffff);
53 state.enabled = true;
54
55 err = pwm_apply_state(vibrator->pwm, &state);
56 if (err) {
57 dev_err(pdev, "failed to apply pwm state: %d", err);
58 return err;
59 }
60
61 if (vibrator->pwm_dir) {
62 pwm_get_state(vibrator->pwm_dir, &state);
63 state.duty_cycle = vibrator->direction_duty_cycle;
64 state.enabled = true;
65
66 err = pwm_apply_state(vibrator->pwm_dir, &state);
67 if (err) {
68 dev_err(pdev, "failed to apply dir-pwm state: %d", err);
69 pwm_disable(vibrator->pwm);
70 return err;
71 }
72 }
73
74 return 0;
75}
76
77static void pwm_vibrator_stop(struct pwm_vibrator *vibrator)
78{
79 if (vibrator->pwm_dir)
80 pwm_disable(vibrator->pwm_dir);
81 pwm_disable(vibrator->pwm);
82
83 if (vibrator->vcc_on) {
84 regulator_disable(vibrator->vcc);
85 vibrator->vcc_on = false;
86 }
87}
88
89static void pwm_vibrator_play_work(struct work_struct *work)
90{
91 struct pwm_vibrator *vibrator = container_of(work,
92 struct pwm_vibrator, play_work);
93
94 if (vibrator->level)
95 pwm_vibrator_start(vibrator);
96 else
97 pwm_vibrator_stop(vibrator);
98}
99
100static int pwm_vibrator_play_effect(struct input_dev *dev, void *data,
101 struct ff_effect *effect)
102{
103 struct pwm_vibrator *vibrator = input_get_drvdata(dev);
104
105 vibrator->level = effect->u.rumble.strong_magnitude;
106 if (!vibrator->level)
107 vibrator->level = effect->u.rumble.weak_magnitude;
108
109 schedule_work(&vibrator->play_work);
110
111 return 0;
112}
113
114static void pwm_vibrator_close(struct input_dev *input)
115{
116 struct pwm_vibrator *vibrator = input_get_drvdata(input);
117
118 cancel_work_sync(&vibrator->play_work);
119 pwm_vibrator_stop(vibrator);
120}
121
122static int pwm_vibrator_probe(struct platform_device *pdev)
123{
124 struct pwm_vibrator *vibrator;
125 struct pwm_state state;
126 int err;
127
128 vibrator = devm_kzalloc(&pdev->dev, sizeof(*vibrator), GFP_KERNEL);
129 if (!vibrator)
130 return -ENOMEM;
131
132 vibrator->input = devm_input_allocate_device(&pdev->dev);
133 if (!vibrator->input)
134 return -ENOMEM;
135
136 vibrator->vcc = devm_regulator_get(&pdev->dev, "vcc");
137 err = PTR_ERR_OR_ZERO(vibrator->vcc);
138 if (err) {
139 if (err != -EPROBE_DEFER)
140 dev_err(&pdev->dev, "Failed to request regulator: %d",
141 err);
142 return err;
143 }
144
145 vibrator->pwm = devm_pwm_get(&pdev->dev, "enable");
146 err = PTR_ERR_OR_ZERO(vibrator->pwm);
147 if (err) {
148 if (err != -EPROBE_DEFER)
149 dev_err(&pdev->dev, "Failed to request main pwm: %d",
150 err);
151 return err;
152 }
153
154 INIT_WORK(&vibrator->play_work, pwm_vibrator_play_work);
155
156
157 pwm_init_state(vibrator->pwm, &state);
158 state.enabled = false;
159 err = pwm_apply_state(vibrator->pwm, &state);
160 if (err) {
161 dev_err(&pdev->dev, "failed to apply initial PWM state: %d",
162 err);
163 return err;
164 }
165
166 vibrator->pwm_dir = devm_pwm_get(&pdev->dev, "direction");
167 err = PTR_ERR_OR_ZERO(vibrator->pwm_dir);
168 switch (err) {
169 case 0:
170
171 pwm_init_state(vibrator->pwm_dir, &state);
172 state.enabled = false;
173 err = pwm_apply_state(vibrator->pwm_dir, &state);
174 if (err) {
175 dev_err(&pdev->dev, "failed to apply initial PWM state: %d",
176 err);
177 return err;
178 }
179
180 vibrator->direction_duty_cycle =
181 pwm_get_period(vibrator->pwm_dir) / 2;
182 device_property_read_u32(&pdev->dev, "direction-duty-cycle-ns",
183 &vibrator->direction_duty_cycle);
184 break;
185
186 case -ENODATA:
187
188 vibrator->pwm_dir = NULL;
189 break;
190
191 default:
192 dev_err(&pdev->dev, "Failed to request direction pwm: %d", err);
193 fallthrough;
194
195 case -EPROBE_DEFER:
196 return err;
197 }
198
199 vibrator->input->name = "pwm-vibrator";
200 vibrator->input->id.bustype = BUS_HOST;
201 vibrator->input->dev.parent = &pdev->dev;
202 vibrator->input->close = pwm_vibrator_close;
203
204 input_set_drvdata(vibrator->input, vibrator);
205 input_set_capability(vibrator->input, EV_FF, FF_RUMBLE);
206
207 err = input_ff_create_memless(vibrator->input, NULL,
208 pwm_vibrator_play_effect);
209 if (err) {
210 dev_err(&pdev->dev, "Couldn't create FF dev: %d", err);
211 return err;
212 }
213
214 err = input_register_device(vibrator->input);
215 if (err) {
216 dev_err(&pdev->dev, "Couldn't register input dev: %d", err);
217 return err;
218 }
219
220 platform_set_drvdata(pdev, vibrator);
221
222 return 0;
223}
224
225static int __maybe_unused pwm_vibrator_suspend(struct device *dev)
226{
227 struct pwm_vibrator *vibrator = dev_get_drvdata(dev);
228
229 cancel_work_sync(&vibrator->play_work);
230 if (vibrator->level)
231 pwm_vibrator_stop(vibrator);
232
233 return 0;
234}
235
236static int __maybe_unused pwm_vibrator_resume(struct device *dev)
237{
238 struct pwm_vibrator *vibrator = dev_get_drvdata(dev);
239
240 if (vibrator->level)
241 pwm_vibrator_start(vibrator);
242
243 return 0;
244}
245
246static SIMPLE_DEV_PM_OPS(pwm_vibrator_pm_ops,
247 pwm_vibrator_suspend, pwm_vibrator_resume);
248
249#ifdef CONFIG_OF
250static const struct of_device_id pwm_vibra_dt_match_table[] = {
251 { .compatible = "pwm-vibrator" },
252 {},
253};
254MODULE_DEVICE_TABLE(of, pwm_vibra_dt_match_table);
255#endif
256
257static struct platform_driver pwm_vibrator_driver = {
258 .probe = pwm_vibrator_probe,
259 .driver = {
260 .name = "pwm-vibrator",
261 .pm = &pwm_vibrator_pm_ops,
262 .of_match_table = of_match_ptr(pwm_vibra_dt_match_table),
263 },
264};
265module_platform_driver(pwm_vibrator_driver);
266
267MODULE_AUTHOR("Sebastian Reichel <sre@kernel.org>");
268MODULE_DESCRIPTION("PWM vibrator driver");
269MODULE_LICENSE("GPL");
270MODULE_ALIAS("platform:pwm-vibrator");
271
