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
26#include <linux/module.h>
27#include <linux/jiffies.h>
28#include <linux/platform_device.h>
29#include <linux/of.h>
30#include <linux/workqueue.h>
31#include <linux/mfd/twl.h>
32#include <linux/mfd/twl4030-audio.h>
33#include <linux/input.h>
34#include <linux/slab.h>
35
36
37#define LEDEN 0x00
38
39
40#define EFFECT_DIR_180_DEG 0x8000
41
42struct vibra_info {
43 struct device *dev;
44 struct input_dev *input_dev;
45
46 struct work_struct play_work;
47
48 bool enabled;
49 int speed;
50 int direction;
51
52 bool coexist;
53};
54
55static void vibra_disable_leds(void)
56{
57 u8 reg;
58
59
60 twl_i2c_read_u8(TWL4030_MODULE_LED, ®, LEDEN);
61 reg &= ~0x03;
62 twl_i2c_write_u8(TWL4030_MODULE_LED, LEDEN, reg);
63}
64
65
66static void vibra_enable(struct vibra_info *info)
67{
68 u8 reg;
69
70 twl4030_audio_enable_resource(TWL4030_AUDIO_RES_POWER);
71
72
73 twl_i2c_read_u8(TWL4030_MODULE_AUDIO_VOICE,
74 ®, TWL4030_REG_VIBRA_CTL);
75 twl_i2c_write_u8(TWL4030_MODULE_AUDIO_VOICE,
76 (reg | TWL4030_VIBRA_EN), TWL4030_REG_VIBRA_CTL);
77
78 twl4030_audio_enable_resource(TWL4030_AUDIO_RES_APLL);
79
80 info->enabled = true;
81}
82
83static void vibra_disable(struct vibra_info *info)
84{
85 u8 reg;
86
87
88 twl_i2c_read_u8(TWL4030_MODULE_AUDIO_VOICE,
89 ®, TWL4030_REG_VIBRA_CTL);
90 twl_i2c_write_u8(TWL4030_MODULE_AUDIO_VOICE,
91 (reg & ~TWL4030_VIBRA_EN), TWL4030_REG_VIBRA_CTL);
92
93 twl4030_audio_disable_resource(TWL4030_AUDIO_RES_APLL);
94 twl4030_audio_disable_resource(TWL4030_AUDIO_RES_POWER);
95
96 info->enabled = false;
97}
98
99static void vibra_play_work(struct work_struct *work)
100{
101 struct vibra_info *info = container_of(work,
102 struct vibra_info, play_work);
103 int dir;
104 int pwm;
105 u8 reg;
106
107 dir = info->direction;
108 pwm = info->speed;
109
110 twl_i2c_read_u8(TWL4030_MODULE_AUDIO_VOICE,
111 ®, TWL4030_REG_VIBRA_CTL);
112 if (pwm && (!info->coexist || !(reg & TWL4030_VIBRA_SEL))) {
113
114 if (!info->enabled)
115 vibra_enable(info);
116
117
118 twl_i2c_read_u8(TWL4030_MODULE_AUDIO_VOICE,
119 ®, TWL4030_REG_VIBRA_CTL);
120 reg = (dir) ? (reg | TWL4030_VIBRA_DIR) :
121 (reg & ~TWL4030_VIBRA_DIR);
122 twl_i2c_write_u8(TWL4030_MODULE_AUDIO_VOICE,
123 reg, TWL4030_REG_VIBRA_CTL);
124
125
126 twl_i2c_write_u8(TWL4030_MODULE_AUDIO_VOICE,
127 256 - pwm, TWL4030_REG_VIBRA_SET);
128 } else {
129 if (info->enabled)
130 vibra_disable(info);
131 }
132}
133
134
135
136static int vibra_play(struct input_dev *input, void *data,
137 struct ff_effect *effect)
138{
139 struct vibra_info *info = input_get_drvdata(input);
140
141 info->speed = effect->u.rumble.strong_magnitude >> 8;
142 if (!info->speed)
143 info->speed = effect->u.rumble.weak_magnitude >> 9;
144 info->direction = effect->direction < EFFECT_DIR_180_DEG ? 0 : 1;
145 schedule_work(&info->play_work);
146 return 0;
147}
148
149static void twl4030_vibra_close(struct input_dev *input)
150{
151 struct vibra_info *info = input_get_drvdata(input);
152
153 cancel_work_sync(&info->play_work);
154
155 if (info->enabled)
156 vibra_disable(info);
157}
158
159
160static int __maybe_unused twl4030_vibra_suspend(struct device *dev)
161{
162 struct platform_device *pdev = to_platform_device(dev);
163 struct vibra_info *info = platform_get_drvdata(pdev);
164
165 if (info->enabled)
166 vibra_disable(info);
167
168 return 0;
169}
170
171static int __maybe_unused twl4030_vibra_resume(struct device *dev)
172{
173 vibra_disable_leds();
174 return 0;
175}
176
177static SIMPLE_DEV_PM_OPS(twl4030_vibra_pm_ops,
178 twl4030_vibra_suspend, twl4030_vibra_resume);
179
180static bool twl4030_vibra_check_coexist(struct twl4030_vibra_data *pdata,
181 struct device_node *parent)
182{
183 struct device_node *node;
184
185 if (pdata && pdata->coexist)
186 return true;
187
188 node = of_get_child_by_name(parent, "codec");
189 if (node) {
190 of_node_put(node);
191 return true;
192 }
193
194 return false;
195}
196
197static int twl4030_vibra_probe(struct platform_device *pdev)
198{
199 struct twl4030_vibra_data *pdata = dev_get_platdata(&pdev->dev);
200 struct device_node *twl4030_core_node = pdev->dev.parent->of_node;
201 struct vibra_info *info;
202 int ret;
203
204 if (!pdata && !twl4030_core_node) {
205 dev_dbg(&pdev->dev, "platform_data not available\n");
206 return -EINVAL;
207 }
208
209 info = devm_kzalloc(&pdev->dev, sizeof(*info), GFP_KERNEL);
210 if (!info)
211 return -ENOMEM;
212
213 info->dev = &pdev->dev;
214 info->coexist = twl4030_vibra_check_coexist(pdata, twl4030_core_node);
215 INIT_WORK(&info->play_work, vibra_play_work);
216
217 info->input_dev = devm_input_allocate_device(&pdev->dev);
218 if (info->input_dev == NULL) {
219 dev_err(&pdev->dev, "couldn't allocate input device\n");
220 return -ENOMEM;
221 }
222
223 input_set_drvdata(info->input_dev, info);
224
225 info->input_dev->name = "twl4030:vibrator";
226 info->input_dev->id.version = 1;
227 info->input_dev->close = twl4030_vibra_close;
228 __set_bit(FF_RUMBLE, info->input_dev->ffbit);
229
230 ret = input_ff_create_memless(info->input_dev, NULL, vibra_play);
231 if (ret < 0) {
232 dev_dbg(&pdev->dev, "couldn't register vibrator to FF\n");
233 return ret;
234 }
235
236 ret = input_register_device(info->input_dev);
237 if (ret < 0) {
238 dev_dbg(&pdev->dev, "couldn't register input device\n");
239 goto err_iff;
240 }
241
242 vibra_disable_leds();
243
244 platform_set_drvdata(pdev, info);
245 return 0;
246
247err_iff:
248 input_ff_destroy(info->input_dev);
249 return ret;
250}
251
252static struct platform_driver twl4030_vibra_driver = {
253 .probe = twl4030_vibra_probe,
254 .driver = {
255 .name = "twl4030-vibra",
256 .pm = &twl4030_vibra_pm_ops,
257 },
258};
259module_platform_driver(twl4030_vibra_driver);
260
261MODULE_ALIAS("platform:twl4030-vibra");
262MODULE_DESCRIPTION("TWL4030 Vibra driver");
263MODULE_LICENSE("GPL");
264MODULE_AUTHOR("Nokia Corporation");
265