]>
Commit | Line | Data |
---|---|---|
4d10da13 DM |
1 | /* |
2 | * DRV2665 haptics driver family | |
3 | * | |
4 | * Author: Dan Murphy <dmurphy@ti.com> | |
5 | * | |
6 | * Copyright: (C) 2015 Texas Instruments, Inc. | |
7 | * | |
8 | * This program is free software; you can redistribute it and/or modify | |
9 | * it under the terms of the GNU General Public License version 2 as | |
10 | * published by the Free Software Foundation. | |
11 | * | |
12 | * This program is distributed in the hope that it will be useful, but | |
13 | * WITHOUT ANY WARRANTY; without even the implied warranty of | |
14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | |
15 | * General Public License for more details. | |
16 | */ | |
17 | ||
18 | #include <linux/i2c.h> | |
19 | #include <linux/input.h> | |
20 | #include <linux/module.h> | |
21 | #include <linux/regmap.h> | |
22 | #include <linux/slab.h> | |
23 | #include <linux/delay.h> | |
24 | #include <linux/regulator/consumer.h> | |
25 | ||
26 | /* Contol registers */ | |
27 | #define DRV2665_STATUS 0x00 | |
28 | #define DRV2665_CTRL_1 0x01 | |
29 | #define DRV2665_CTRL_2 0x02 | |
30 | #define DRV2665_FIFO 0x0b | |
31 | ||
32 | /* Status Register */ | |
33 | #define DRV2665_FIFO_FULL BIT(0) | |
34 | #define DRV2665_FIFO_EMPTY BIT(1) | |
35 | ||
36 | /* Control 1 Register */ | |
37 | #define DRV2665_25_VPP_GAIN 0x00 | |
38 | #define DRV2665_50_VPP_GAIN 0x01 | |
39 | #define DRV2665_75_VPP_GAIN 0x02 | |
40 | #define DRV2665_100_VPP_GAIN 0x03 | |
41 | #define DRV2665_DIGITAL_IN 0xfc | |
42 | #define DRV2665_ANALOG_IN BIT(2) | |
43 | ||
44 | /* Control 2 Register */ | |
45 | #define DRV2665_BOOST_EN BIT(1) | |
46 | #define DRV2665_STANDBY BIT(6) | |
47 | #define DRV2665_DEV_RST BIT(7) | |
48 | #define DRV2665_5_MS_IDLE_TOUT 0x00 | |
49 | #define DRV2665_10_MS_IDLE_TOUT 0x04 | |
50 | #define DRV2665_15_MS_IDLE_TOUT 0x08 | |
51 | #define DRV2665_20_MS_IDLE_TOUT 0x0c | |
52 | ||
53 | /** | |
54 | * struct drv2665_data - | |
55 | * @input_dev - Pointer to the input device | |
56 | * @client - Pointer to the I2C client | |
57 | * @regmap - Register map of the device | |
58 | * @work - Work item used to off load the enable/disable of the vibration | |
59 | * @regulator - Pointer to the regulator for the IC | |
60 | */ | |
61 | struct drv2665_data { | |
62 | struct input_dev *input_dev; | |
63 | struct i2c_client *client; | |
64 | struct regmap *regmap; | |
65 | struct work_struct work; | |
66 | struct regulator *regulator; | |
67 | }; | |
68 | ||
69 | /* 8kHz Sine wave to stream to the FIFO */ | |
70 | static const u8 drv2665_sine_wave_form[] = { | |
71 | 0x00, 0x10, 0x20, 0x2e, 0x3c, 0x48, 0x53, 0x5b, 0x61, 0x65, 0x66, | |
72 | 0x65, 0x61, 0x5b, 0x53, 0x48, 0x3c, 0x2e, 0x20, 0x10, | |
73 | 0x00, 0xf0, 0xe0, 0xd2, 0xc4, 0xb8, 0xad, 0xa5, 0x9f, 0x9b, 0x9a, | |
74 | 0x9b, 0x9f, 0xa5, 0xad, 0xb8, 0xc4, 0xd2, 0xe0, 0xf0, 0x00, | |
75 | }; | |
76 | ||
ec0843fa | 77 | static const struct reg_default drv2665_reg_defs[] = { |
4d10da13 DM |
78 | { DRV2665_STATUS, 0x02 }, |
79 | { DRV2665_CTRL_1, 0x28 }, | |
80 | { DRV2665_CTRL_2, 0x40 }, | |
81 | { DRV2665_FIFO, 0x00 }, | |
82 | }; | |
83 | ||
84 | static void drv2665_worker(struct work_struct *work) | |
85 | { | |
86 | struct drv2665_data *haptics = | |
87 | container_of(work, struct drv2665_data, work); | |
88 | unsigned int read_buf; | |
89 | int error; | |
90 | ||
91 | error = regmap_read(haptics->regmap, DRV2665_STATUS, &read_buf); | |
92 | if (error) { | |
93 | dev_err(&haptics->client->dev, | |
94 | "Failed to read status: %d\n", error); | |
95 | return; | |
96 | } | |
97 | ||
98 | if (read_buf & DRV2665_FIFO_EMPTY) { | |
99 | error = regmap_bulk_write(haptics->regmap, | |
100 | DRV2665_FIFO, | |
101 | drv2665_sine_wave_form, | |
102 | ARRAY_SIZE(drv2665_sine_wave_form)); | |
103 | if (error) { | |
104 | dev_err(&haptics->client->dev, | |
105 | "Failed to write FIFO: %d\n", error); | |
106 | return; | |
107 | } | |
108 | } | |
109 | } | |
110 | ||
111 | static int drv2665_haptics_play(struct input_dev *input, void *data, | |
112 | struct ff_effect *effect) | |
113 | { | |
114 | struct drv2665_data *haptics = input_get_drvdata(input); | |
115 | ||
116 | schedule_work(&haptics->work); | |
117 | ||
118 | return 0; | |
119 | } | |
120 | ||
121 | static void drv2665_close(struct input_dev *input) | |
122 | { | |
123 | struct drv2665_data *haptics = input_get_drvdata(input); | |
124 | int error; | |
125 | ||
126 | cancel_work_sync(&haptics->work); | |
127 | ||
037b3af6 FV |
128 | error = regmap_update_bits(haptics->regmap, DRV2665_CTRL_2, |
129 | DRV2665_STANDBY, DRV2665_STANDBY); | |
4d10da13 DM |
130 | if (error) |
131 | dev_err(&haptics->client->dev, | |
132 | "Failed to enter standby mode: %d\n", error); | |
133 | } | |
134 | ||
8019ff6c | 135 | static const struct reg_sequence drv2665_init_regs[] = { |
4d10da13 DM |
136 | { DRV2665_CTRL_2, 0 | DRV2665_10_MS_IDLE_TOUT }, |
137 | { DRV2665_CTRL_1, DRV2665_25_VPP_GAIN }, | |
138 | }; | |
139 | ||
140 | static int drv2665_init(struct drv2665_data *haptics) | |
141 | { | |
142 | int error; | |
143 | ||
144 | error = regmap_register_patch(haptics->regmap, | |
145 | drv2665_init_regs, | |
146 | ARRAY_SIZE(drv2665_init_regs)); | |
147 | if (error) { | |
148 | dev_err(&haptics->client->dev, | |
149 | "Failed to write init registers: %d\n", | |
150 | error); | |
151 | return error; | |
152 | } | |
153 | ||
154 | return 0; | |
155 | } | |
156 | ||
157 | static const struct regmap_config drv2665_regmap_config = { | |
158 | .reg_bits = 8, | |
159 | .val_bits = 8, | |
160 | ||
161 | .max_register = DRV2665_FIFO, | |
162 | .reg_defaults = drv2665_reg_defs, | |
163 | .num_reg_defaults = ARRAY_SIZE(drv2665_reg_defs), | |
164 | .cache_type = REGCACHE_NONE, | |
165 | }; | |
166 | ||
167 | static int drv2665_probe(struct i2c_client *client, | |
168 | const struct i2c_device_id *id) | |
169 | { | |
170 | struct drv2665_data *haptics; | |
171 | int error; | |
172 | ||
173 | haptics = devm_kzalloc(&client->dev, sizeof(*haptics), GFP_KERNEL); | |
174 | if (!haptics) | |
175 | return -ENOMEM; | |
176 | ||
177 | haptics->regulator = devm_regulator_get(&client->dev, "vbat"); | |
178 | if (IS_ERR(haptics->regulator)) { | |
179 | error = PTR_ERR(haptics->regulator); | |
180 | dev_err(&client->dev, | |
181 | "unable to get regulator, error: %d\n", error); | |
182 | return error; | |
183 | } | |
184 | ||
185 | haptics->input_dev = devm_input_allocate_device(&client->dev); | |
186 | if (!haptics->input_dev) { | |
187 | dev_err(&client->dev, "Failed to allocate input device\n"); | |
188 | return -ENOMEM; | |
189 | } | |
190 | ||
191 | haptics->input_dev->name = "drv2665:haptics"; | |
192 | haptics->input_dev->dev.parent = client->dev.parent; | |
193 | haptics->input_dev->close = drv2665_close; | |
194 | input_set_drvdata(haptics->input_dev, haptics); | |
195 | input_set_capability(haptics->input_dev, EV_FF, FF_RUMBLE); | |
196 | ||
197 | error = input_ff_create_memless(haptics->input_dev, NULL, | |
198 | drv2665_haptics_play); | |
199 | if (error) { | |
200 | dev_err(&client->dev, "input_ff_create() failed: %d\n", | |
201 | error); | |
202 | return error; | |
203 | } | |
204 | ||
205 | INIT_WORK(&haptics->work, drv2665_worker); | |
206 | ||
207 | haptics->client = client; | |
208 | i2c_set_clientdata(client, haptics); | |
209 | ||
210 | haptics->regmap = devm_regmap_init_i2c(client, &drv2665_regmap_config); | |
211 | if (IS_ERR(haptics->regmap)) { | |
212 | error = PTR_ERR(haptics->regmap); | |
213 | dev_err(&client->dev, "Failed to allocate register map: %d\n", | |
214 | error); | |
215 | return error; | |
216 | } | |
217 | ||
218 | error = drv2665_init(haptics); | |
219 | if (error) { | |
220 | dev_err(&client->dev, "Device init failed: %d\n", error); | |
221 | return error; | |
222 | } | |
223 | ||
224 | error = input_register_device(haptics->input_dev); | |
225 | if (error) { | |
226 | dev_err(&client->dev, "couldn't register input device: %d\n", | |
227 | error); | |
228 | return error; | |
229 | } | |
230 | ||
231 | return 0; | |
232 | } | |
233 | ||
234 | static int __maybe_unused drv2665_suspend(struct device *dev) | |
235 | { | |
236 | struct drv2665_data *haptics = dev_get_drvdata(dev); | |
237 | int ret = 0; | |
238 | ||
239 | mutex_lock(&haptics->input_dev->mutex); | |
240 | ||
241 | if (haptics->input_dev->users) { | |
242 | ret = regmap_update_bits(haptics->regmap, DRV2665_CTRL_2, | |
037b3af6 | 243 | DRV2665_STANDBY, DRV2665_STANDBY); |
4d10da13 DM |
244 | if (ret) { |
245 | dev_err(dev, "Failed to set standby mode\n"); | |
246 | regulator_disable(haptics->regulator); | |
247 | goto out; | |
248 | } | |
249 | ||
250 | ret = regulator_disable(haptics->regulator); | |
251 | if (ret) { | |
252 | dev_err(dev, "Failed to disable regulator\n"); | |
253 | regmap_update_bits(haptics->regmap, | |
254 | DRV2665_CTRL_2, | |
255 | DRV2665_STANDBY, 0); | |
256 | } | |
257 | } | |
258 | out: | |
259 | mutex_unlock(&haptics->input_dev->mutex); | |
260 | return ret; | |
261 | } | |
262 | ||
263 | static int __maybe_unused drv2665_resume(struct device *dev) | |
264 | { | |
265 | struct drv2665_data *haptics = dev_get_drvdata(dev); | |
266 | int ret = 0; | |
267 | ||
268 | mutex_lock(&haptics->input_dev->mutex); | |
269 | ||
270 | if (haptics->input_dev->users) { | |
271 | ret = regulator_enable(haptics->regulator); | |
272 | if (ret) { | |
273 | dev_err(dev, "Failed to enable regulator\n"); | |
274 | goto out; | |
275 | } | |
276 | ||
277 | ret = regmap_update_bits(haptics->regmap, DRV2665_CTRL_2, | |
278 | DRV2665_STANDBY, 0); | |
279 | if (ret) { | |
280 | dev_err(dev, "Failed to unset standby mode\n"); | |
281 | regulator_disable(haptics->regulator); | |
282 | goto out; | |
283 | } | |
284 | ||
285 | } | |
286 | ||
287 | out: | |
288 | mutex_unlock(&haptics->input_dev->mutex); | |
289 | return ret; | |
290 | } | |
291 | ||
292 | static SIMPLE_DEV_PM_OPS(drv2665_pm_ops, drv2665_suspend, drv2665_resume); | |
293 | ||
294 | static const struct i2c_device_id drv2665_id[] = { | |
295 | { "drv2665", 0 }, | |
296 | { } | |
297 | }; | |
298 | MODULE_DEVICE_TABLE(i2c, drv2665_id); | |
299 | ||
300 | #ifdef CONFIG_OF | |
301 | static const struct of_device_id drv2665_of_match[] = { | |
302 | { .compatible = "ti,drv2665", }, | |
303 | { } | |
304 | }; | |
305 | MODULE_DEVICE_TABLE(of, drv2665_of_match); | |
306 | #endif | |
307 | ||
308 | static struct i2c_driver drv2665_driver = { | |
309 | .probe = drv2665_probe, | |
310 | .driver = { | |
311 | .name = "drv2665-haptics", | |
4d10da13 DM |
312 | .of_match_table = of_match_ptr(drv2665_of_match), |
313 | .pm = &drv2665_pm_ops, | |
314 | }, | |
315 | .id_table = drv2665_id, | |
316 | }; | |
317 | module_i2c_driver(drv2665_driver); | |
318 | ||
319 | MODULE_DESCRIPTION("TI DRV2665 haptics driver"); | |
320 | MODULE_LICENSE("GPL"); | |
321 | MODULE_AUTHOR("Dan Murphy <dmurphy@ti.com>"); |