Loading...
1/*
2 * qt2160.c - Atmel AT42QT2160 Touch Sense Controller
3 *
4 * Copyright (C) 2009 Raphael Derosso Pereira <raphaelpereira@gmail.com>
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
10 *
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
15 *
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
19 */
20
21#include <linux/kernel.h>
22#include <linux/leds.h>
23#include <linux/module.h>
24#include <linux/slab.h>
25#include <linux/jiffies.h>
26#include <linux/i2c.h>
27#include <linux/irq.h>
28#include <linux/interrupt.h>
29#include <linux/input.h>
30
31#define QT2160_VALID_CHIPID 0x11
32
33#define QT2160_CMD_CHIPID 0
34#define QT2160_CMD_CODEVER 1
35#define QT2160_CMD_GSTAT 2
36#define QT2160_CMD_KEYS3 3
37#define QT2160_CMD_KEYS4 4
38#define QT2160_CMD_SLIDE 5
39#define QT2160_CMD_GPIOS 6
40#define QT2160_CMD_SUBVER 7
41#define QT2160_CMD_CALIBRATE 10
42#define QT2160_CMD_DRIVE_X 70
43#define QT2160_CMD_PWMEN_X 74
44#define QT2160_CMD_PWM_DUTY 76
45
46#define QT2160_NUM_LEDS_X 8
47
48#define QT2160_CYCLE_INTERVAL (2*HZ)
49
50static unsigned char qt2160_key2code[] = {
51 KEY_0, KEY_1, KEY_2, KEY_3,
52 KEY_4, KEY_5, KEY_6, KEY_7,
53 KEY_8, KEY_9, KEY_A, KEY_B,
54 KEY_C, KEY_D, KEY_E, KEY_F,
55};
56
57#ifdef CONFIG_LEDS_CLASS
58struct qt2160_led {
59 struct qt2160_data *qt2160;
60 struct led_classdev cdev;
61 struct work_struct work;
62 char name[32];
63 int id;
64 enum led_brightness new_brightness;
65};
66#endif
67
68struct qt2160_data {
69 struct i2c_client *client;
70 struct input_dev *input;
71 struct delayed_work dwork;
72 spinlock_t lock; /* Protects canceling/rescheduling of dwork */
73 unsigned short keycodes[ARRAY_SIZE(qt2160_key2code)];
74 u16 key_matrix;
75#ifdef CONFIG_LEDS_CLASS
76 struct qt2160_led leds[QT2160_NUM_LEDS_X];
77 struct mutex led_lock;
78#endif
79};
80
81static int qt2160_read(struct i2c_client *client, u8 reg);
82static int qt2160_write(struct i2c_client *client, u8 reg, u8 data);
83
84#ifdef CONFIG_LEDS_CLASS
85
86static void qt2160_led_work(struct work_struct *work)
87{
88 struct qt2160_led *led = container_of(work, struct qt2160_led, work);
89 struct qt2160_data *qt2160 = led->qt2160;
90 struct i2c_client *client = qt2160->client;
91 int value = led->new_brightness;
92 u32 drive, pwmen;
93
94 mutex_lock(&qt2160->led_lock);
95
96 drive = qt2160_read(client, QT2160_CMD_DRIVE_X);
97 pwmen = qt2160_read(client, QT2160_CMD_PWMEN_X);
98 if (value != LED_OFF) {
99 drive |= (1 << led->id);
100 pwmen |= (1 << led->id);
101
102 } else {
103 drive &= ~(1 << led->id);
104 pwmen &= ~(1 << led->id);
105 }
106 qt2160_write(client, QT2160_CMD_DRIVE_X, drive);
107 qt2160_write(client, QT2160_CMD_PWMEN_X, pwmen);
108
109 /*
110 * Changing this register will change the brightness
111 * of every LED in the qt2160. It's a HW limitation.
112 */
113 if (value != LED_OFF)
114 qt2160_write(client, QT2160_CMD_PWM_DUTY, value);
115
116 mutex_unlock(&qt2160->led_lock);
117}
118
119static void qt2160_led_set(struct led_classdev *cdev,
120 enum led_brightness value)
121{
122 struct qt2160_led *led = container_of(cdev, struct qt2160_led, cdev);
123
124 led->new_brightness = value;
125 schedule_work(&led->work);
126}
127
128#endif /* CONFIG_LEDS_CLASS */
129
130static int qt2160_read_block(struct i2c_client *client,
131 u8 inireg, u8 *buffer, unsigned int count)
132{
133 int error, idx = 0;
134
135 /*
136 * Can't use SMBus block data read. Check for I2C functionality to speed
137 * things up whenever possible. Otherwise we will be forced to read
138 * sequentially.
139 */
140 if (i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
141
142 error = i2c_smbus_write_byte(client, inireg + idx);
143 if (error) {
144 dev_err(&client->dev,
145 "couldn't send request. Returned %d\n", error);
146 return error;
147 }
148
149 error = i2c_master_recv(client, buffer, count);
150 if (error != count) {
151 dev_err(&client->dev,
152 "couldn't read registers. Returned %d bytes\n", error);
153 return error;
154 }
155 } else {
156
157 while (count--) {
158 int data;
159
160 error = i2c_smbus_write_byte(client, inireg + idx);
161 if (error) {
162 dev_err(&client->dev,
163 "couldn't send request. Returned %d\n", error);
164 return error;
165 }
166
167 data = i2c_smbus_read_byte(client);
168 if (data < 0) {
169 dev_err(&client->dev,
170 "couldn't read register. Returned %d\n", data);
171 return data;
172 }
173
174 buffer[idx++] = data;
175 }
176 }
177
178 return 0;
179}
180
181static int qt2160_get_key_matrix(struct qt2160_data *qt2160)
182{
183 struct i2c_client *client = qt2160->client;
184 struct input_dev *input = qt2160->input;
185 u8 regs[6];
186 u16 old_matrix, new_matrix;
187 int ret, i, mask;
188
189 dev_dbg(&client->dev, "requesting keys...\n");
190
191 /*
192 * Read all registers from General Status Register
193 * to GPIOs register
194 */
195 ret = qt2160_read_block(client, QT2160_CMD_GSTAT, regs, 6);
196 if (ret) {
197 dev_err(&client->dev,
198 "could not perform chip read.\n");
199 return ret;
200 }
201
202 old_matrix = qt2160->key_matrix;
203 qt2160->key_matrix = new_matrix = (regs[2] << 8) | regs[1];
204
205 mask = 0x01;
206 for (i = 0; i < 16; ++i, mask <<= 1) {
207 int keyval = new_matrix & mask;
208
209 if ((old_matrix & mask) != keyval) {
210 input_report_key(input, qt2160->keycodes[i], keyval);
211 dev_dbg(&client->dev, "key %d %s\n",
212 i, keyval ? "pressed" : "released");
213 }
214 }
215
216 input_sync(input);
217
218 return 0;
219}
220
221static irqreturn_t qt2160_irq(int irq, void *_qt2160)
222{
223 struct qt2160_data *qt2160 = _qt2160;
224 unsigned long flags;
225
226 spin_lock_irqsave(&qt2160->lock, flags);
227
228 mod_delayed_work(system_wq, &qt2160->dwork, 0);
229
230 spin_unlock_irqrestore(&qt2160->lock, flags);
231
232 return IRQ_HANDLED;
233}
234
235static void qt2160_schedule_read(struct qt2160_data *qt2160)
236{
237 spin_lock_irq(&qt2160->lock);
238 schedule_delayed_work(&qt2160->dwork, QT2160_CYCLE_INTERVAL);
239 spin_unlock_irq(&qt2160->lock);
240}
241
242static void qt2160_worker(struct work_struct *work)
243{
244 struct qt2160_data *qt2160 =
245 container_of(work, struct qt2160_data, dwork.work);
246
247 dev_dbg(&qt2160->client->dev, "worker\n");
248
249 qt2160_get_key_matrix(qt2160);
250
251 /* Avoid device lock up by checking every so often */
252 qt2160_schedule_read(qt2160);
253}
254
255static int qt2160_read(struct i2c_client *client, u8 reg)
256{
257 int ret;
258
259 ret = i2c_smbus_write_byte(client, reg);
260 if (ret) {
261 dev_err(&client->dev,
262 "couldn't send request. Returned %d\n", ret);
263 return ret;
264 }
265
266 ret = i2c_smbus_read_byte(client);
267 if (ret < 0) {
268 dev_err(&client->dev,
269 "couldn't read register. Returned %d\n", ret);
270 return ret;
271 }
272
273 return ret;
274}
275
276static int qt2160_write(struct i2c_client *client, u8 reg, u8 data)
277{
278 int ret;
279
280 ret = i2c_smbus_write_byte_data(client, reg, data);
281 if (ret < 0)
282 dev_err(&client->dev,
283 "couldn't write data. Returned %d\n", ret);
284
285 return ret;
286}
287
288#ifdef CONFIG_LEDS_CLASS
289
290static int qt2160_register_leds(struct qt2160_data *qt2160)
291{
292 struct i2c_client *client = qt2160->client;
293 int ret;
294 int i;
295
296 mutex_init(&qt2160->led_lock);
297
298 for (i = 0; i < QT2160_NUM_LEDS_X; i++) {
299 struct qt2160_led *led = &qt2160->leds[i];
300
301 snprintf(led->name, sizeof(led->name), "qt2160:x%d", i);
302 led->cdev.name = led->name;
303 led->cdev.brightness_set = qt2160_led_set;
304 led->cdev.brightness = LED_OFF;
305 led->id = i;
306 led->qt2160 = qt2160;
307
308 INIT_WORK(&led->work, qt2160_led_work);
309
310 ret = led_classdev_register(&client->dev, &led->cdev);
311 if (ret < 0)
312 return ret;
313 }
314
315 /* Tur off LEDs */
316 qt2160_write(client, QT2160_CMD_DRIVE_X, 0);
317 qt2160_write(client, QT2160_CMD_PWMEN_X, 0);
318 qt2160_write(client, QT2160_CMD_PWM_DUTY, 0);
319
320 return 0;
321}
322
323static void qt2160_unregister_leds(struct qt2160_data *qt2160)
324{
325 int i;
326
327 for (i = 0; i < QT2160_NUM_LEDS_X; i++) {
328 led_classdev_unregister(&qt2160->leds[i].cdev);
329 cancel_work_sync(&qt2160->leds[i].work);
330 }
331}
332
333#else
334
335static inline int qt2160_register_leds(struct qt2160_data *qt2160)
336{
337 return 0;
338}
339
340static inline void qt2160_unregister_leds(struct qt2160_data *qt2160)
341{
342}
343
344#endif
345
346static bool qt2160_identify(struct i2c_client *client)
347{
348 int id, ver, rev;
349
350 /* Read Chid ID to check if chip is valid */
351 id = qt2160_read(client, QT2160_CMD_CHIPID);
352 if (id != QT2160_VALID_CHIPID) {
353 dev_err(&client->dev, "ID %d not supported\n", id);
354 return false;
355 }
356
357 /* Read chip firmware version */
358 ver = qt2160_read(client, QT2160_CMD_CODEVER);
359 if (ver < 0) {
360 dev_err(&client->dev, "could not get firmware version\n");
361 return false;
362 }
363
364 /* Read chip firmware revision */
365 rev = qt2160_read(client, QT2160_CMD_SUBVER);
366 if (rev < 0) {
367 dev_err(&client->dev, "could not get firmware revision\n");
368 return false;
369 }
370
371 dev_info(&client->dev, "AT42QT2160 firmware version %d.%d.%d\n",
372 ver >> 4, ver & 0xf, rev);
373
374 return true;
375}
376
377static int qt2160_probe(struct i2c_client *client,
378 const struct i2c_device_id *id)
379{
380 struct qt2160_data *qt2160;
381 struct input_dev *input;
382 int i;
383 int error;
384
385 /* Check functionality */
386 error = i2c_check_functionality(client->adapter,
387 I2C_FUNC_SMBUS_BYTE);
388 if (!error) {
389 dev_err(&client->dev, "%s adapter not supported\n",
390 dev_driver_string(&client->adapter->dev));
391 return -ENODEV;
392 }
393
394 if (!qt2160_identify(client))
395 return -ENODEV;
396
397 /* Chip is valid and active. Allocate structure */
398 qt2160 = kzalloc(sizeof(struct qt2160_data), GFP_KERNEL);
399 input = input_allocate_device();
400 if (!qt2160 || !input) {
401 dev_err(&client->dev, "insufficient memory\n");
402 error = -ENOMEM;
403 goto err_free_mem;
404 }
405
406 qt2160->client = client;
407 qt2160->input = input;
408 INIT_DELAYED_WORK(&qt2160->dwork, qt2160_worker);
409 spin_lock_init(&qt2160->lock);
410
411 input->name = "AT42QT2160 Touch Sense Keyboard";
412 input->id.bustype = BUS_I2C;
413
414 input->keycode = qt2160->keycodes;
415 input->keycodesize = sizeof(qt2160->keycodes[0]);
416 input->keycodemax = ARRAY_SIZE(qt2160_key2code);
417
418 __set_bit(EV_KEY, input->evbit);
419 __clear_bit(EV_REP, input->evbit);
420 for (i = 0; i < ARRAY_SIZE(qt2160_key2code); i++) {
421 qt2160->keycodes[i] = qt2160_key2code[i];
422 __set_bit(qt2160_key2code[i], input->keybit);
423 }
424 __clear_bit(KEY_RESERVED, input->keybit);
425
426 /* Calibrate device */
427 error = qt2160_write(client, QT2160_CMD_CALIBRATE, 1);
428 if (error) {
429 dev_err(&client->dev, "failed to calibrate device\n");
430 goto err_free_mem;
431 }
432
433 if (client->irq) {
434 error = request_irq(client->irq, qt2160_irq,
435 IRQF_TRIGGER_FALLING, "qt2160", qt2160);
436 if (error) {
437 dev_err(&client->dev,
438 "failed to allocate irq %d\n", client->irq);
439 goto err_free_mem;
440 }
441 }
442
443 error = qt2160_register_leds(qt2160);
444 if (error) {
445 dev_err(&client->dev, "Failed to register leds\n");
446 goto err_free_irq;
447 }
448
449 error = input_register_device(qt2160->input);
450 if (error) {
451 dev_err(&client->dev,
452 "Failed to register input device\n");
453 goto err_unregister_leds;
454 }
455
456 i2c_set_clientdata(client, qt2160);
457 qt2160_schedule_read(qt2160);
458
459 return 0;
460
461err_unregister_leds:
462 qt2160_unregister_leds(qt2160);
463err_free_irq:
464 if (client->irq)
465 free_irq(client->irq, qt2160);
466err_free_mem:
467 input_free_device(input);
468 kfree(qt2160);
469 return error;
470}
471
472static int qt2160_remove(struct i2c_client *client)
473{
474 struct qt2160_data *qt2160 = i2c_get_clientdata(client);
475
476 qt2160_unregister_leds(qt2160);
477
478 /* Release IRQ so no queue will be scheduled */
479 if (client->irq)
480 free_irq(client->irq, qt2160);
481
482 cancel_delayed_work_sync(&qt2160->dwork);
483
484 input_unregister_device(qt2160->input);
485 kfree(qt2160);
486
487 return 0;
488}
489
490static const struct i2c_device_id qt2160_idtable[] = {
491 { "qt2160", 0, },
492 { }
493};
494
495MODULE_DEVICE_TABLE(i2c, qt2160_idtable);
496
497static struct i2c_driver qt2160_driver = {
498 .driver = {
499 .name = "qt2160",
500 },
501
502 .id_table = qt2160_idtable,
503 .probe = qt2160_probe,
504 .remove = qt2160_remove,
505};
506
507module_i2c_driver(qt2160_driver);
508
509MODULE_AUTHOR("Raphael Derosso Pereira <raphaelpereira@gmail.com>");
510MODULE_DESCRIPTION("Driver for AT42QT2160 Touch Sensor");
511MODULE_LICENSE("GPL");
1/*
2 * qt2160.c - Atmel AT42QT2160 Touch Sense Controller
3 *
4 * Copyright (C) 2009 Raphael Derosso Pereira <raphaelpereira@gmail.com>
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
10 *
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
15 *
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
19 */
20
21#include <linux/kernel.h>
22#include <linux/init.h>
23#include <linux/module.h>
24#include <linux/slab.h>
25#include <linux/jiffies.h>
26#include <linux/i2c.h>
27#include <linux/irq.h>
28#include <linux/interrupt.h>
29#include <linux/input.h>
30
31#define QT2160_VALID_CHIPID 0x11
32
33#define QT2160_CMD_CHIPID 0
34#define QT2160_CMD_CODEVER 1
35#define QT2160_CMD_GSTAT 2
36#define QT2160_CMD_KEYS3 3
37#define QT2160_CMD_KEYS4 4
38#define QT2160_CMD_SLIDE 5
39#define QT2160_CMD_GPIOS 6
40#define QT2160_CMD_SUBVER 7
41#define QT2160_CMD_CALIBRATE 10
42
43#define QT2160_CYCLE_INTERVAL (2*HZ)
44
45static unsigned char qt2160_key2code[] = {
46 KEY_0, KEY_1, KEY_2, KEY_3,
47 KEY_4, KEY_5, KEY_6, KEY_7,
48 KEY_8, KEY_9, KEY_A, KEY_B,
49 KEY_C, KEY_D, KEY_E, KEY_F,
50};
51
52struct qt2160_data {
53 struct i2c_client *client;
54 struct input_dev *input;
55 struct delayed_work dwork;
56 spinlock_t lock; /* Protects canceling/rescheduling of dwork */
57 unsigned short keycodes[ARRAY_SIZE(qt2160_key2code)];
58 u16 key_matrix;
59};
60
61static int qt2160_read_block(struct i2c_client *client,
62 u8 inireg, u8 *buffer, unsigned int count)
63{
64 int error, idx = 0;
65
66 /*
67 * Can't use SMBus block data read. Check for I2C functionality to speed
68 * things up whenever possible. Otherwise we will be forced to read
69 * sequentially.
70 */
71 if (i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
72
73 error = i2c_smbus_write_byte(client, inireg + idx);
74 if (error) {
75 dev_err(&client->dev,
76 "couldn't send request. Returned %d\n", error);
77 return error;
78 }
79
80 error = i2c_master_recv(client, buffer, count);
81 if (error != count) {
82 dev_err(&client->dev,
83 "couldn't read registers. Returned %d bytes\n", error);
84 return error;
85 }
86 } else {
87
88 while (count--) {
89 int data;
90
91 error = i2c_smbus_write_byte(client, inireg + idx);
92 if (error) {
93 dev_err(&client->dev,
94 "couldn't send request. Returned %d\n", error);
95 return error;
96 }
97
98 data = i2c_smbus_read_byte(client);
99 if (data < 0) {
100 dev_err(&client->dev,
101 "couldn't read register. Returned %d\n", data);
102 return data;
103 }
104
105 buffer[idx++] = data;
106 }
107 }
108
109 return 0;
110}
111
112static int qt2160_get_key_matrix(struct qt2160_data *qt2160)
113{
114 struct i2c_client *client = qt2160->client;
115 struct input_dev *input = qt2160->input;
116 u8 regs[6];
117 u16 old_matrix, new_matrix;
118 int ret, i, mask;
119
120 dev_dbg(&client->dev, "requesting keys...\n");
121
122 /*
123 * Read all registers from General Status Register
124 * to GPIOs register
125 */
126 ret = qt2160_read_block(client, QT2160_CMD_GSTAT, regs, 6);
127 if (ret) {
128 dev_err(&client->dev,
129 "could not perform chip read.\n");
130 return ret;
131 }
132
133 old_matrix = qt2160->key_matrix;
134 qt2160->key_matrix = new_matrix = (regs[2] << 8) | regs[1];
135
136 mask = 0x01;
137 for (i = 0; i < 16; ++i, mask <<= 1) {
138 int keyval = new_matrix & mask;
139
140 if ((old_matrix & mask) != keyval) {
141 input_report_key(input, qt2160->keycodes[i], keyval);
142 dev_dbg(&client->dev, "key %d %s\n",
143 i, keyval ? "pressed" : "released");
144 }
145 }
146
147 input_sync(input);
148
149 return 0;
150}
151
152static irqreturn_t qt2160_irq(int irq, void *_qt2160)
153{
154 struct qt2160_data *qt2160 = _qt2160;
155 unsigned long flags;
156
157 spin_lock_irqsave(&qt2160->lock, flags);
158
159 __cancel_delayed_work(&qt2160->dwork);
160 schedule_delayed_work(&qt2160->dwork, 0);
161
162 spin_unlock_irqrestore(&qt2160->lock, flags);
163
164 return IRQ_HANDLED;
165}
166
167static void qt2160_schedule_read(struct qt2160_data *qt2160)
168{
169 spin_lock_irq(&qt2160->lock);
170 schedule_delayed_work(&qt2160->dwork, QT2160_CYCLE_INTERVAL);
171 spin_unlock_irq(&qt2160->lock);
172}
173
174static void qt2160_worker(struct work_struct *work)
175{
176 struct qt2160_data *qt2160 =
177 container_of(work, struct qt2160_data, dwork.work);
178
179 dev_dbg(&qt2160->client->dev, "worker\n");
180
181 qt2160_get_key_matrix(qt2160);
182
183 /* Avoid device lock up by checking every so often */
184 qt2160_schedule_read(qt2160);
185}
186
187static int __devinit qt2160_read(struct i2c_client *client, u8 reg)
188{
189 int ret;
190
191 ret = i2c_smbus_write_byte(client, reg);
192 if (ret) {
193 dev_err(&client->dev,
194 "couldn't send request. Returned %d\n", ret);
195 return ret;
196 }
197
198 ret = i2c_smbus_read_byte(client);
199 if (ret < 0) {
200 dev_err(&client->dev,
201 "couldn't read register. Returned %d\n", ret);
202 return ret;
203 }
204
205 return ret;
206}
207
208static int __devinit qt2160_write(struct i2c_client *client, u8 reg, u8 data)
209{
210 int error;
211
212 error = i2c_smbus_write_byte(client, reg);
213 if (error) {
214 dev_err(&client->dev,
215 "couldn't send request. Returned %d\n", error);
216 return error;
217 }
218
219 error = i2c_smbus_write_byte(client, data);
220 if (error) {
221 dev_err(&client->dev,
222 "couldn't write data. Returned %d\n", error);
223 return error;
224 }
225
226 return error;
227}
228
229
230static bool __devinit qt2160_identify(struct i2c_client *client)
231{
232 int id, ver, rev;
233
234 /* Read Chid ID to check if chip is valid */
235 id = qt2160_read(client, QT2160_CMD_CHIPID);
236 if (id != QT2160_VALID_CHIPID) {
237 dev_err(&client->dev, "ID %d not supported\n", id);
238 return false;
239 }
240
241 /* Read chip firmware version */
242 ver = qt2160_read(client, QT2160_CMD_CODEVER);
243 if (ver < 0) {
244 dev_err(&client->dev, "could not get firmware version\n");
245 return false;
246 }
247
248 /* Read chip firmware revision */
249 rev = qt2160_read(client, QT2160_CMD_SUBVER);
250 if (rev < 0) {
251 dev_err(&client->dev, "could not get firmware revision\n");
252 return false;
253 }
254
255 dev_info(&client->dev, "AT42QT2160 firmware version %d.%d.%d\n",
256 ver >> 4, ver & 0xf, rev);
257
258 return true;
259}
260
261static int __devinit qt2160_probe(struct i2c_client *client,
262 const struct i2c_device_id *id)
263{
264 struct qt2160_data *qt2160;
265 struct input_dev *input;
266 int i;
267 int error;
268
269 /* Check functionality */
270 error = i2c_check_functionality(client->adapter,
271 I2C_FUNC_SMBUS_BYTE);
272 if (!error) {
273 dev_err(&client->dev, "%s adapter not supported\n",
274 dev_driver_string(&client->adapter->dev));
275 return -ENODEV;
276 }
277
278 if (!qt2160_identify(client))
279 return -ENODEV;
280
281 /* Chip is valid and active. Allocate structure */
282 qt2160 = kzalloc(sizeof(struct qt2160_data), GFP_KERNEL);
283 input = input_allocate_device();
284 if (!qt2160 || !input) {
285 dev_err(&client->dev, "insufficient memory\n");
286 error = -ENOMEM;
287 goto err_free_mem;
288 }
289
290 qt2160->client = client;
291 qt2160->input = input;
292 INIT_DELAYED_WORK(&qt2160->dwork, qt2160_worker);
293 spin_lock_init(&qt2160->lock);
294
295 input->name = "AT42QT2160 Touch Sense Keyboard";
296 input->id.bustype = BUS_I2C;
297
298 input->keycode = qt2160->keycodes;
299 input->keycodesize = sizeof(qt2160->keycodes[0]);
300 input->keycodemax = ARRAY_SIZE(qt2160_key2code);
301
302 __set_bit(EV_KEY, input->evbit);
303 __clear_bit(EV_REP, input->evbit);
304 for (i = 0; i < ARRAY_SIZE(qt2160_key2code); i++) {
305 qt2160->keycodes[i] = qt2160_key2code[i];
306 __set_bit(qt2160_key2code[i], input->keybit);
307 }
308 __clear_bit(KEY_RESERVED, input->keybit);
309
310 /* Calibrate device */
311 error = qt2160_write(client, QT2160_CMD_CALIBRATE, 1);
312 if (error) {
313 dev_err(&client->dev, "failed to calibrate device\n");
314 goto err_free_mem;
315 }
316
317 if (client->irq) {
318 error = request_irq(client->irq, qt2160_irq,
319 IRQF_TRIGGER_FALLING, "qt2160", qt2160);
320 if (error) {
321 dev_err(&client->dev,
322 "failed to allocate irq %d\n", client->irq);
323 goto err_free_mem;
324 }
325 }
326
327 error = input_register_device(qt2160->input);
328 if (error) {
329 dev_err(&client->dev,
330 "Failed to register input device\n");
331 goto err_free_irq;
332 }
333
334 i2c_set_clientdata(client, qt2160);
335 qt2160_schedule_read(qt2160);
336
337 return 0;
338
339err_free_irq:
340 if (client->irq)
341 free_irq(client->irq, qt2160);
342err_free_mem:
343 input_free_device(input);
344 kfree(qt2160);
345 return error;
346}
347
348static int __devexit qt2160_remove(struct i2c_client *client)
349{
350 struct qt2160_data *qt2160 = i2c_get_clientdata(client);
351
352 /* Release IRQ so no queue will be scheduled */
353 if (client->irq)
354 free_irq(client->irq, qt2160);
355
356 cancel_delayed_work_sync(&qt2160->dwork);
357
358 input_unregister_device(qt2160->input);
359 kfree(qt2160);
360
361 return 0;
362}
363
364static const struct i2c_device_id qt2160_idtable[] = {
365 { "qt2160", 0, },
366 { }
367};
368
369MODULE_DEVICE_TABLE(i2c, qt2160_idtable);
370
371static struct i2c_driver qt2160_driver = {
372 .driver = {
373 .name = "qt2160",
374 .owner = THIS_MODULE,
375 },
376
377 .id_table = qt2160_idtable,
378 .probe = qt2160_probe,
379 .remove = __devexit_p(qt2160_remove),
380};
381
382static int __init qt2160_init(void)
383{
384 return i2c_add_driver(&qt2160_driver);
385}
386module_init(qt2160_init);
387
388static void __exit qt2160_cleanup(void)
389{
390 i2c_del_driver(&qt2160_driver);
391}
392module_exit(qt2160_cleanup);
393
394MODULE_AUTHOR("Raphael Derosso Pereira <raphaelpereira@gmail.com>");
395MODULE_DESCRIPTION("Driver for AT42QT2160 Touch Sensor");
396MODULE_LICENSE("GPL");