1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25#include <linux/module.h>
26#include <linux/slab.h>
27#include <linux/platform_device.h>
28#include <linux/err.h>
29#include <linux/pwm.h>
30#include <linux/input.h>
31#include <linux/mfd/max8997-private.h>
32#include <linux/mfd/max8997.h>
33#include <linux/regulator/consumer.h>
34
35
36#define MAX8997_MOTOR_TYPE_SHIFT 7
37#define MAX8997_ENABLE_SHIFT 6
38#define MAX8997_MODE_SHIFT 5
39
40
41#define MAX8997_CYCLE_SHIFT 6
42#define MAX8997_SIG_PERIOD_SHIFT 4
43#define MAX8997_SIG_DUTY_SHIFT 2
44#define MAX8997_PWM_DUTY_SHIFT 0
45
46struct max8997_haptic {
47 struct device *dev;
48 struct i2c_client *client;
49 struct input_dev *input_dev;
50 struct regulator *regulator;
51
52 struct work_struct work;
53 struct mutex mutex;
54
55 bool enabled;
56 unsigned int level;
57
58 struct pwm_device *pwm;
59 unsigned int pwm_period;
60 enum max8997_haptic_pwm_divisor pwm_divisor;
61
62 enum max8997_haptic_motor_type type;
63 enum max8997_haptic_pulse_mode mode;
64
65 unsigned int internal_mode_pattern;
66 unsigned int pattern_cycle;
67 unsigned int pattern_signal_period;
68};
69
70static int max8997_haptic_set_duty_cycle(struct max8997_haptic *chip)
71{
72 int ret = 0;
73
74 if (chip->mode == MAX8997_EXTERNAL_MODE) {
75 unsigned int duty = chip->pwm_period * chip->level / 100;
76 ret = pwm_config(chip->pwm, duty, chip->pwm_period);
77 } else {
78 int i;
79 u8 duty_index = 0;
80
81 for (i = 0; i <= 64; i++) {
82 if (chip->level <= i * 100 / 64) {
83 duty_index = i;
84 break;
85 }
86 }
87 switch (chip->internal_mode_pattern) {
88 case 0:
89 max8997_write_reg(chip->client,
90 MAX8997_HAPTIC_REG_SIGPWMDC1, duty_index);
91 break;
92 case 1:
93 max8997_write_reg(chip->client,
94 MAX8997_HAPTIC_REG_SIGPWMDC2, duty_index);
95 break;
96 case 2:
97 max8997_write_reg(chip->client,
98 MAX8997_HAPTIC_REG_SIGPWMDC3, duty_index);
99 break;
100 case 3:
101 max8997_write_reg(chip->client,
102 MAX8997_HAPTIC_REG_SIGPWMDC4, duty_index);
103 break;
104 default:
105 break;
106 }
107 }
108 return ret;
109}
110
111static void max8997_haptic_configure(struct max8997_haptic *chip)
112{
113 u8 value;
114
115 value = chip->type << MAX8997_MOTOR_TYPE_SHIFT |
116 chip->enabled << MAX8997_ENABLE_SHIFT |
117 chip->mode << MAX8997_MODE_SHIFT | chip->pwm_divisor;
118 max8997_write_reg(chip->client, MAX8997_HAPTIC_REG_CONF2, value);
119
120 if (chip->mode == MAX8997_INTERNAL_MODE && chip->enabled) {
121 value = chip->internal_mode_pattern << MAX8997_CYCLE_SHIFT |
122 chip->internal_mode_pattern << MAX8997_SIG_PERIOD_SHIFT |
123 chip->internal_mode_pattern << MAX8997_SIG_DUTY_SHIFT |
124 chip->internal_mode_pattern << MAX8997_PWM_DUTY_SHIFT;
125 max8997_write_reg(chip->client,
126 MAX8997_HAPTIC_REG_DRVCONF, value);
127
128 switch (chip->internal_mode_pattern) {
129 case 0:
130 value = chip->pattern_cycle << 4;
131 max8997_write_reg(chip->client,
132 MAX8997_HAPTIC_REG_CYCLECONF1, value);
133 value = chip->pattern_signal_period;
134 max8997_write_reg(chip->client,
135 MAX8997_HAPTIC_REG_SIGCONF1, value);
136 break;
137
138 case 1:
139 value = chip->pattern_cycle;
140 max8997_write_reg(chip->client,
141 MAX8997_HAPTIC_REG_CYCLECONF1, value);
142 value = chip->pattern_signal_period;
143 max8997_write_reg(chip->client,
144 MAX8997_HAPTIC_REG_SIGCONF2, value);
145 break;
146
147 case 2:
148 value = chip->pattern_cycle << 4;
149 max8997_write_reg(chip->client,
150 MAX8997_HAPTIC_REG_CYCLECONF2, value);
151 value = chip->pattern_signal_period;
152 max8997_write_reg(chip->client,
153 MAX8997_HAPTIC_REG_SIGCONF3, value);
154 break;
155
156 case 3:
157 value = chip->pattern_cycle;
158 max8997_write_reg(chip->client,
159 MAX8997_HAPTIC_REG_CYCLECONF2, value);
160 value = chip->pattern_signal_period;
161 max8997_write_reg(chip->client,
162 MAX8997_HAPTIC_REG_SIGCONF4, value);
163 break;
164
165 default:
166 break;
167 }
168 }
169}
170
171static void max8997_haptic_enable(struct max8997_haptic *chip)
172{
173 int error;
174
175 mutex_lock(&chip->mutex);
176
177 error = max8997_haptic_set_duty_cycle(chip);
178 if (error) {
179 dev_err(chip->dev, "set_pwm_cycle failed, error: %d\n", error);
180 goto out;
181 }
182
183 if (!chip->enabled) {
184 error = regulator_enable(chip->regulator);
185 if (error) {
186 dev_err(chip->dev, "Failed to enable regulator\n");
187 goto out;
188 }
189 max8997_haptic_configure(chip);
190 if (chip->mode == MAX8997_EXTERNAL_MODE) {
191 error = pwm_enable(chip->pwm);
192 if (error) {
193 dev_err(chip->dev, "Failed to enable PWM\n");
194 regulator_disable(chip->regulator);
195 goto out;
196 }
197 }
198 chip->enabled = true;
199 }
200
201out:
202 mutex_unlock(&chip->mutex);
203}
204
205static void max8997_haptic_disable(struct max8997_haptic *chip)
206{
207 mutex_lock(&chip->mutex);
208
209 if (chip->enabled) {
210 chip->enabled = false;
211 max8997_haptic_configure(chip);
212 if (chip->mode == MAX8997_EXTERNAL_MODE)
213 pwm_disable(chip->pwm);
214 regulator_disable(chip->regulator);
215 }
216
217 mutex_unlock(&chip->mutex);
218}
219
220static void max8997_haptic_play_effect_work(struct work_struct *work)
221{
222 struct max8997_haptic *chip =
223 container_of(work, struct max8997_haptic, work);
224
225 if (chip->level)
226 max8997_haptic_enable(chip);
227 else
228 max8997_haptic_disable(chip);
229}
230
231static int max8997_haptic_play_effect(struct input_dev *dev, void *data,
232 struct ff_effect *effect)
233{
234 struct max8997_haptic *chip = input_get_drvdata(dev);
235
236 chip->level = effect->u.rumble.strong_magnitude;
237 if (!chip->level)
238 chip->level = effect->u.rumble.weak_magnitude;
239
240 schedule_work(&chip->work);
241
242 return 0;
243}
244
245static void max8997_haptic_close(struct input_dev *dev)
246{
247 struct max8997_haptic *chip = input_get_drvdata(dev);
248
249 cancel_work_sync(&chip->work);
250 max8997_haptic_disable(chip);
251}
252
253static int max8997_haptic_probe(struct platform_device *pdev)
254{
255 struct max8997_dev *iodev = dev_get_drvdata(pdev->dev.parent);
256 const struct max8997_platform_data *pdata =
257 dev_get_platdata(iodev->dev);
258 const struct max8997_haptic_platform_data *haptic_pdata = NULL;
259 struct max8997_haptic *chip;
260 struct input_dev *input_dev;
261 int error;
262
263 if (pdata)
264 haptic_pdata = pdata->haptic_pdata;
265
266 if (!haptic_pdata) {
267 dev_err(&pdev->dev, "no haptic platform data\n");
268 return -EINVAL;
269 }
270
271 chip = kzalloc(sizeof(struct max8997_haptic), GFP_KERNEL);
272 input_dev = input_allocate_device();
273 if (!chip || !input_dev) {
274 dev_err(&pdev->dev, "unable to allocate memory\n");
275 error = -ENOMEM;
276 goto err_free_mem;
277 }
278
279 INIT_WORK(&chip->work, max8997_haptic_play_effect_work);
280 mutex_init(&chip->mutex);
281
282 chip->client = iodev->haptic;
283 chip->dev = &pdev->dev;
284 chip->input_dev = input_dev;
285 chip->pwm_period = haptic_pdata->pwm_period;
286 chip->type = haptic_pdata->type;
287 chip->mode = haptic_pdata->mode;
288 chip->pwm_divisor = haptic_pdata->pwm_divisor;
289
290 switch (chip->mode) {
291 case MAX8997_INTERNAL_MODE:
292 chip->internal_mode_pattern =
293 haptic_pdata->internal_mode_pattern;
294 chip->pattern_cycle = haptic_pdata->pattern_cycle;
295 chip->pattern_signal_period =
296 haptic_pdata->pattern_signal_period;
297 break;
298
299 case MAX8997_EXTERNAL_MODE:
300 chip->pwm = pwm_request(haptic_pdata->pwm_channel_id,
301 "max8997-haptic");
302 if (IS_ERR(chip->pwm)) {
303 error = PTR_ERR(chip->pwm);
304 dev_err(&pdev->dev,
305 "unable to request PWM for haptic, error: %d\n",
306 error);
307 goto err_free_mem;
308 }
309 break;
310
311 default:
312 dev_err(&pdev->dev,
313 "Invalid chip mode specified (%d)\n", chip->mode);
314 error = -EINVAL;
315 goto err_free_mem;
316 }
317
318 chip->regulator = regulator_get(&pdev->dev, "inmotor");
319 if (IS_ERR(chip->regulator)) {
320 error = PTR_ERR(chip->regulator);
321 dev_err(&pdev->dev,
322 "unable to get regulator, error: %d\n",
323 error);
324 goto err_free_pwm;
325 }
326
327 input_dev->name = "max8997-haptic";
328 input_dev->id.version = 1;
329 input_dev->dev.parent = &pdev->dev;
330 input_dev->close = max8997_haptic_close;
331 input_set_drvdata(input_dev, chip);
332 input_set_capability(input_dev, EV_FF, FF_RUMBLE);
333
334 error = input_ff_create_memless(input_dev, NULL,
335 max8997_haptic_play_effect);
336 if (error) {
337 dev_err(&pdev->dev,
338 "unable to create FF device, error: %d\n",
339 error);
340 goto err_put_regulator;
341 }
342
343 error = input_register_device(input_dev);
344 if (error) {
345 dev_err(&pdev->dev,
346 "unable to register input device, error: %d\n",
347 error);
348 goto err_destroy_ff;
349 }
350
351 platform_set_drvdata(pdev, chip);
352 return 0;
353
354err_destroy_ff:
355 input_ff_destroy(input_dev);
356err_put_regulator:
357 regulator_put(chip->regulator);
358err_free_pwm:
359 if (chip->mode == MAX8997_EXTERNAL_MODE)
360 pwm_free(chip->pwm);
361err_free_mem:
362 input_free_device(input_dev);
363 kfree(chip);
364
365 return error;
366}
367
368static int max8997_haptic_remove(struct platform_device *pdev)
369{
370 struct max8997_haptic *chip = platform_get_drvdata(pdev);
371
372 input_unregister_device(chip->input_dev);
373 regulator_put(chip->regulator);
374
375 if (chip->mode == MAX8997_EXTERNAL_MODE)
376 pwm_free(chip->pwm);
377
378 kfree(chip);
379
380 return 0;
381}
382
383static int __maybe_unused max8997_haptic_suspend(struct device *dev)
384{
385 struct platform_device *pdev = to_platform_device(dev);
386 struct max8997_haptic *chip = platform_get_drvdata(pdev);
387
388 max8997_haptic_disable(chip);
389
390 return 0;
391}
392
393static SIMPLE_DEV_PM_OPS(max8997_haptic_pm_ops, max8997_haptic_suspend, NULL);
394
395static const struct platform_device_id max8997_haptic_id[] = {
396 { "max8997-haptic", 0 },
397 { },
398};
399MODULE_DEVICE_TABLE(platform, max8997_haptic_id);
400
401static struct platform_driver max8997_haptic_driver = {
402 .driver = {
403 .name = "max8997-haptic",
404 .pm = &max8997_haptic_pm_ops,
405 },
406 .probe = max8997_haptic_probe,
407 .remove = max8997_haptic_remove,
408 .id_table = max8997_haptic_id,
409};
410module_platform_driver(max8997_haptic_driver);
411
412MODULE_AUTHOR("Donggeun Kim <dg77.kim@samsung.com>");
413MODULE_DESCRIPTION("max8997_haptic driver");
414MODULE_LICENSE("GPL");
415
