1 /*
2 * twl4030-vibra.c - TWL4030 Vibrator driver
3 *
4 * Copyright (C) 2008-2010 Nokia Corporation
5 *
6 * Written by Henrik Saari <henrik.saari@nokia.com>
7 * Updates by Felipe Balbi <felipe.balbi@nokia.com>
8 * Input by Jari Vanhala <ext-jari.vanhala@nokia.com>
9 *
10 * This program is free software; you can redistribute it and/or modify
11 * it under the terms of the GNU General Public License version 2 as
12 * published by the Free Software Foundation.
13 *
14 * This program is distributed in the hope that it will be useful, but
15 * WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
17 * General Public License for more details.
18 *
19 * You should have received a copy of the GNU General Public License
20 * along with this program; if not, write to the Free Software
21 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
22 * 02110-1301 USA
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/i2c/twl.h>
32 #include <linux/mfd/twl4030-audio.h>
33 #include <linux/input.h>
34 #include <linux/slab.h>
35
36 /* MODULE ID2 */
37 #define LEDEN 0x00
38
39 /* ForceFeedback */
40 #define EFFECT_DIR_180_DEG 0x8000 /* range is 0 - 0xFFFF */
41
42 struct 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
vibra_disable_leds(void)55 static void vibra_disable_leds(void)
56 {
57 u8 reg;
58
59 /* Disable LEDA & LEDB, cannot be used with vibra (PWM) */
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 /* Powers H-Bridge and enables audio clk */
vibra_enable(struct vibra_info * info)66 static void vibra_enable(struct vibra_info *info)
67 {
68 u8 reg;
69
70 twl4030_audio_enable_resource(TWL4030_AUDIO_RES_POWER);
71
72 /* turn H-Bridge on */
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
vibra_disable(struct vibra_info * info)83 static void vibra_disable(struct vibra_info *info)
84 {
85 u8 reg;
86
87 /* Power down H-Bridge */
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
vibra_play_work(struct work_struct * work)99 static 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 /* set vibra rotation direction */
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 /* set PWM, 1 = max, 255 = min */
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 /*** Input/ForceFeedback ***/
135
vibra_play(struct input_dev * input,void * data,struct ff_effect * effect)136 static 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
twl4030_vibra_close(struct input_dev * input)149 static 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 /*** Module ***/
160 #ifdef CONFIG_PM_SLEEP
twl4030_vibra_suspend(struct device * dev)161 static int twl4030_vibra_suspend(struct device *dev)
162 {
163 struct platform_device *pdev = to_platform_device(dev);
164 struct vibra_info *info = platform_get_drvdata(pdev);
165
166 if (info->enabled)
167 vibra_disable(info);
168
169 return 0;
170 }
171
twl4030_vibra_resume(struct device * dev)172 static int twl4030_vibra_resume(struct device *dev)
173 {
174 vibra_disable_leds();
175 return 0;
176 }
177 #endif
178
179 static SIMPLE_DEV_PM_OPS(twl4030_vibra_pm_ops,
180 twl4030_vibra_suspend, twl4030_vibra_resume);
181
twl4030_vibra_check_coexist(struct twl4030_vibra_data * pdata,struct device_node * parent)182 static bool twl4030_vibra_check_coexist(struct twl4030_vibra_data *pdata,
183 struct device_node *parent)
184 {
185 struct device_node *node;
186
187 if (pdata && pdata->coexist)
188 return true;
189
190 node = of_get_child_by_name(parent, "codec");
191 if (node) {
192 of_node_put(node);
193 return true;
194 }
195
196 return false;
197 }
198
twl4030_vibra_probe(struct platform_device * pdev)199 static int twl4030_vibra_probe(struct platform_device *pdev)
200 {
201 struct twl4030_vibra_data *pdata = dev_get_platdata(&pdev->dev);
202 struct device_node *twl4030_core_node = pdev->dev.parent->of_node;
203 struct vibra_info *info;
204 int ret;
205
206 if (!pdata && !twl4030_core_node) {
207 dev_dbg(&pdev->dev, "platform_data not available\n");
208 return -EINVAL;
209 }
210
211 info = devm_kzalloc(&pdev->dev, sizeof(*info), GFP_KERNEL);
212 if (!info)
213 return -ENOMEM;
214
215 info->dev = &pdev->dev;
216 info->coexist = twl4030_vibra_check_coexist(pdata, twl4030_core_node);
217 INIT_WORK(&info->play_work, vibra_play_work);
218
219 info->input_dev = devm_input_allocate_device(&pdev->dev);
220 if (info->input_dev == NULL) {
221 dev_err(&pdev->dev, "couldn't allocate input device\n");
222 return -ENOMEM;
223 }
224
225 input_set_drvdata(info->input_dev, info);
226
227 info->input_dev->name = "twl4030:vibrator";
228 info->input_dev->id.version = 1;
229 info->input_dev->dev.parent = pdev->dev.parent;
230 info->input_dev->close = twl4030_vibra_close;
231 __set_bit(FF_RUMBLE, info->input_dev->ffbit);
232
233 ret = input_ff_create_memless(info->input_dev, NULL, vibra_play);
234 if (ret < 0) {
235 dev_dbg(&pdev->dev, "couldn't register vibrator to FF\n");
236 return ret;
237 }
238
239 ret = input_register_device(info->input_dev);
240 if (ret < 0) {
241 dev_dbg(&pdev->dev, "couldn't register input device\n");
242 goto err_iff;
243 }
244
245 vibra_disable_leds();
246
247 platform_set_drvdata(pdev, info);
248 return 0;
249
250 err_iff:
251 input_ff_destroy(info->input_dev);
252 return ret;
253 }
254
255 static struct platform_driver twl4030_vibra_driver = {
256 .probe = twl4030_vibra_probe,
257 .driver = {
258 .name = "twl4030-vibra",
259 .owner = THIS_MODULE,
260 .pm = &twl4030_vibra_pm_ops,
261 },
262 };
263 module_platform_driver(twl4030_vibra_driver);
264
265 MODULE_ALIAS("platform:twl4030-vibra");
266 MODULE_DESCRIPTION("TWL4030 Vibra driver");
267 MODULE_LICENSE("GPL");
268 MODULE_AUTHOR("Nokia Corporation");
269