percpu, x86: don't use PMD_SIZE as embedded atom_size on 32bit
[zen-stable.git] / drivers / input / keyboard / qt2160.c
blobfac695157e8afce221fb8dae22fa2d750d745963
1 /*
2 * qt2160.c - Atmel AT42QT2160 Touch Sense Controller
4 * Copyright (C) 2009 Raphael Derosso Pereira <raphaelpereira@gmail.com>
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.
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.
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.
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>
31 #define QT2160_VALID_CHIPID 0x11
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
43 #define QT2160_CYCLE_INTERVAL (2*HZ)
45 static 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,
52 struct 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;
61 static int qt2160_read_block(struct i2c_client *client,
62 u8 inireg, u8 *buffer, unsigned int count)
64 int error, idx = 0;
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.
71 if (i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
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;
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;
86 } else {
88 while (count--) {
89 int data;
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;
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;
105 buffer[idx++] = data;
109 return 0;
112 static int qt2160_get_key_matrix(struct qt2160_data *qt2160)
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;
120 dev_dbg(&client->dev, "requesting keys...\n");
123 * Read all registers from General Status Register
124 * to GPIOs register
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;
133 old_matrix = qt2160->key_matrix;
134 qt2160->key_matrix = new_matrix = (regs[2] << 8) | regs[1];
136 mask = 0x01;
137 for (i = 0; i < 16; ++i, mask <<= 1) {
138 int keyval = new_matrix & mask;
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");
147 input_sync(input);
149 return 0;
152 static irqreturn_t qt2160_irq(int irq, void *_qt2160)
154 struct qt2160_data *qt2160 = _qt2160;
155 unsigned long flags;
157 spin_lock_irqsave(&qt2160->lock, flags);
159 __cancel_delayed_work(&qt2160->dwork);
160 schedule_delayed_work(&qt2160->dwork, 0);
162 spin_unlock_irqrestore(&qt2160->lock, flags);
164 return IRQ_HANDLED;
167 static void qt2160_schedule_read(struct qt2160_data *qt2160)
169 spin_lock_irq(&qt2160->lock);
170 schedule_delayed_work(&qt2160->dwork, QT2160_CYCLE_INTERVAL);
171 spin_unlock_irq(&qt2160->lock);
174 static void qt2160_worker(struct work_struct *work)
176 struct qt2160_data *qt2160 =
177 container_of(work, struct qt2160_data, dwork.work);
179 dev_dbg(&qt2160->client->dev, "worker\n");
181 qt2160_get_key_matrix(qt2160);
183 /* Avoid device lock up by checking every so often */
184 qt2160_schedule_read(qt2160);
187 static int __devinit qt2160_read(struct i2c_client *client, u8 reg)
189 int ret;
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;
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;
205 return ret;
208 static int __devinit qt2160_write(struct i2c_client *client, u8 reg, u8 data)
210 int error;
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;
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;
226 return error;
230 static bool __devinit qt2160_identify(struct i2c_client *client)
232 int id, ver, rev;
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;
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;
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;
255 dev_info(&client->dev, "AT42QT2160 firmware version %d.%d.%d\n",
256 ver >> 4, ver & 0xf, rev);
258 return true;
261 static int __devinit qt2160_probe(struct i2c_client *client,
262 const struct i2c_device_id *id)
264 struct qt2160_data *qt2160;
265 struct input_dev *input;
266 int i;
267 int error;
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;
278 if (!qt2160_identify(client))
279 return -ENODEV;
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;
290 qt2160->client = client;
291 qt2160->input = input;
292 INIT_DELAYED_WORK(&qt2160->dwork, qt2160_worker);
293 spin_lock_init(&qt2160->lock);
295 input->name = "AT42QT2160 Touch Sense Keyboard";
296 input->id.bustype = BUS_I2C;
298 input->keycode = qt2160->keycodes;
299 input->keycodesize = sizeof(qt2160->keycodes[0]);
300 input->keycodemax = ARRAY_SIZE(qt2160_key2code);
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);
308 __clear_bit(KEY_RESERVED, input->keybit);
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;
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;
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;
334 i2c_set_clientdata(client, qt2160);
335 qt2160_schedule_read(qt2160);
337 return 0;
339 err_free_irq:
340 if (client->irq)
341 free_irq(client->irq, qt2160);
342 err_free_mem:
343 input_free_device(input);
344 kfree(qt2160);
345 return error;
348 static int __devexit qt2160_remove(struct i2c_client *client)
350 struct qt2160_data *qt2160 = i2c_get_clientdata(client);
352 /* Release IRQ so no queue will be scheduled */
353 if (client->irq)
354 free_irq(client->irq, qt2160);
356 cancel_delayed_work_sync(&qt2160->dwork);
358 input_unregister_device(qt2160->input);
359 kfree(qt2160);
361 return 0;
364 static const struct i2c_device_id qt2160_idtable[] = {
365 { "qt2160", 0, },
369 MODULE_DEVICE_TABLE(i2c, qt2160_idtable);
371 static struct i2c_driver qt2160_driver = {
372 .driver = {
373 .name = "qt2160",
374 .owner = THIS_MODULE,
377 .id_table = qt2160_idtable,
378 .probe = qt2160_probe,
379 .remove = __devexit_p(qt2160_remove),
382 static int __init qt2160_init(void)
384 return i2c_add_driver(&qt2160_driver);
386 module_init(qt2160_init);
388 static void __exit qt2160_cleanup(void)
390 i2c_del_driver(&qt2160_driver);
392 module_exit(qt2160_cleanup);
394 MODULE_AUTHOR("Raphael Derosso Pereira <raphaelpereira@gmail.com>");
395 MODULE_DESCRIPTION("Driver for AT42QT2160 Touch Sensor");
396 MODULE_LICENSE("GPL");