2 * File: drivers/input/keyboard/adp5588_keys.c
3 * Description: keypad driver for ADP5588 and ADP5587
4 * I2C QWERTY Keypad and IO Expander
5 * Bugs: Enter bugs at http://blackfin.uclinux.org/
7 * Copyright (C) 2008-2010 Analog Devices Inc.
8 * Licensed under the GPL-2 or later.
11 #include <linux/module.h>
12 #include <linux/init.h>
13 #include <linux/interrupt.h>
14 #include <linux/irq.h>
15 #include <linux/workqueue.h>
16 #include <linux/errno.h>
18 #include <linux/platform_device.h>
19 #include <linux/input.h>
20 #include <linux/i2c.h>
21 #include <linux/gpio.h>
22 #include <linux/slab.h>
24 #include <linux/i2c/adp5588.h>
26 /* Key Event Register xy */
27 #define KEY_EV_PRESSED (1 << 7)
28 #define KEY_EV_MASK (0x7F)
30 #define KP_SEL(x) (0xFFFF >> (16 - x)) /* 2^x-1 */
32 #define KEYP_MAX_EVENT 10
35 * Early pre 4.0 Silicon required to delay readout by at least 25ms,
36 * since the Event Counter Register updated 25ms after the interrupt
39 #define WA_DELAYED_READOUT_REVID(rev) ((rev) < 4)
42 struct i2c_client
*client
;
43 struct input_dev
*input
;
44 struct delayed_work work
;
46 unsigned short keycode
[ADP5588_KEYMAPSIZE
];
47 const struct adp5588_gpi_map
*gpimap
;
48 unsigned short gpimapsize
;
50 unsigned char gpiomap
[ADP5588_MAXGPIO
];
53 struct mutex gpio_lock
; /* Protect cached dir, dat_out */
59 static int adp5588_read(struct i2c_client
*client
, u8 reg
)
61 int ret
= i2c_smbus_read_byte_data(client
, reg
);
64 dev_err(&client
->dev
, "Read Error\n");
69 static int adp5588_write(struct i2c_client
*client
, u8 reg
, u8 val
)
71 return i2c_smbus_write_byte_data(client
, reg
, val
);
75 static int adp5588_gpio_get_value(struct gpio_chip
*chip
, unsigned off
)
77 struct adp5588_kpad
*kpad
= container_of(chip
, struct adp5588_kpad
, gc
);
78 unsigned int bank
= ADP5588_BANK(kpad
->gpiomap
[off
]);
79 unsigned int bit
= ADP5588_BIT(kpad
->gpiomap
[off
]);
81 return !!(adp5588_read(kpad
->client
, GPIO_DAT_STAT1
+ bank
) & bit
);
84 static void adp5588_gpio_set_value(struct gpio_chip
*chip
,
85 unsigned off
, int val
)
87 struct adp5588_kpad
*kpad
= container_of(chip
, struct adp5588_kpad
, gc
);
88 unsigned int bank
= ADP5588_BANK(kpad
->gpiomap
[off
]);
89 unsigned int bit
= ADP5588_BIT(kpad
->gpiomap
[off
]);
91 mutex_lock(&kpad
->gpio_lock
);
94 kpad
->dat_out
[bank
] |= bit
;
96 kpad
->dat_out
[bank
] &= ~bit
;
98 adp5588_write(kpad
->client
, GPIO_DAT_OUT1
+ bank
,
101 mutex_unlock(&kpad
->gpio_lock
);
104 static int adp5588_gpio_direction_input(struct gpio_chip
*chip
, unsigned off
)
106 struct adp5588_kpad
*kpad
= container_of(chip
, struct adp5588_kpad
, gc
);
107 unsigned int bank
= ADP5588_BANK(kpad
->gpiomap
[off
]);
108 unsigned int bit
= ADP5588_BIT(kpad
->gpiomap
[off
]);
111 mutex_lock(&kpad
->gpio_lock
);
113 kpad
->dir
[bank
] &= ~bit
;
114 ret
= adp5588_write(kpad
->client
, GPIO_DIR1
+ bank
, kpad
->dir
[bank
]);
116 mutex_unlock(&kpad
->gpio_lock
);
121 static int adp5588_gpio_direction_output(struct gpio_chip
*chip
,
122 unsigned off
, int val
)
124 struct adp5588_kpad
*kpad
= container_of(chip
, struct adp5588_kpad
, gc
);
125 unsigned int bank
= ADP5588_BANK(kpad
->gpiomap
[off
]);
126 unsigned int bit
= ADP5588_BIT(kpad
->gpiomap
[off
]);
129 mutex_lock(&kpad
->gpio_lock
);
131 kpad
->dir
[bank
] |= bit
;
134 kpad
->dat_out
[bank
] |= bit
;
136 kpad
->dat_out
[bank
] &= ~bit
;
138 ret
= adp5588_write(kpad
->client
, GPIO_DAT_OUT1
+ bank
,
139 kpad
->dat_out
[bank
]);
140 ret
|= adp5588_write(kpad
->client
, GPIO_DIR1
+ bank
,
143 mutex_unlock(&kpad
->gpio_lock
);
148 static int __devinit
adp5588_build_gpiomap(struct adp5588_kpad
*kpad
,
149 const struct adp5588_kpad_platform_data
*pdata
)
151 bool pin_used
[ADP5588_MAXGPIO
];
155 memset(pin_used
, 0, sizeof(pin_used
));
157 for (i
= 0; i
< pdata
->rows
; i
++)
160 for (i
= 0; i
< pdata
->cols
; i
++)
161 pin_used
[i
+ GPI_PIN_COL_BASE
- GPI_PIN_BASE
] = true;
163 for (i
= 0; i
< kpad
->gpimapsize
; i
++)
164 pin_used
[kpad
->gpimap
[i
].pin
- GPI_PIN_BASE
] = true;
166 for (i
= 0; i
< ADP5588_MAXGPIO
; i
++)
168 kpad
->gpiomap
[n_unused
++] = i
;
173 static int __devinit
adp5588_gpio_add(struct adp5588_kpad
*kpad
)
175 struct device
*dev
= &kpad
->client
->dev
;
176 const struct adp5588_kpad_platform_data
*pdata
= dev
->platform_data
;
177 const struct adp5588_gpio_platform_data
*gpio_data
= pdata
->gpio_data
;
183 kpad
->gc
.ngpio
= adp5588_build_gpiomap(kpad
, pdata
);
184 if (kpad
->gc
.ngpio
== 0) {
185 dev_info(dev
, "No unused gpios left to export\n");
189 kpad
->export_gpio
= true;
191 kpad
->gc
.direction_input
= adp5588_gpio_direction_input
;
192 kpad
->gc
.direction_output
= adp5588_gpio_direction_output
;
193 kpad
->gc
.get
= adp5588_gpio_get_value
;
194 kpad
->gc
.set
= adp5588_gpio_set_value
;
195 kpad
->gc
.can_sleep
= 1;
197 kpad
->gc
.base
= gpio_data
->gpio_start
;
198 kpad
->gc
.label
= kpad
->client
->name
;
199 kpad
->gc
.owner
= THIS_MODULE
;
201 mutex_init(&kpad
->gpio_lock
);
203 error
= gpiochip_add(&kpad
->gc
);
205 dev_err(dev
, "gpiochip_add failed, err: %d\n", error
);
209 for (i
= 0; i
<= ADP5588_BANK(ADP5588_MAXGPIO
); i
++) {
210 kpad
->dat_out
[i
] = adp5588_read(kpad
->client
,
212 kpad
->dir
[i
] = adp5588_read(kpad
->client
, GPIO_DIR1
+ i
);
215 if (gpio_data
->setup
) {
216 error
= gpio_data
->setup(kpad
->client
,
217 kpad
->gc
.base
, kpad
->gc
.ngpio
,
220 dev_warn(dev
, "setup failed, %d\n", error
);
226 static void __devexit
adp5588_gpio_remove(struct adp5588_kpad
*kpad
)
228 struct device
*dev
= &kpad
->client
->dev
;
229 const struct adp5588_kpad_platform_data
*pdata
= dev
->platform_data
;
230 const struct adp5588_gpio_platform_data
*gpio_data
= pdata
->gpio_data
;
233 if (!kpad
->export_gpio
)
236 if (gpio_data
->teardown
) {
237 error
= gpio_data
->teardown(kpad
->client
,
238 kpad
->gc
.base
, kpad
->gc
.ngpio
,
241 dev_warn(dev
, "teardown failed %d\n", error
);
244 error
= gpiochip_remove(&kpad
->gc
);
246 dev_warn(dev
, "gpiochip_remove failed %d\n", error
);
249 static inline int adp5588_gpio_add(struct adp5588_kpad
*kpad
)
254 static inline void adp5588_gpio_remove(struct adp5588_kpad
*kpad
)
259 static void adp5588_report_events(struct adp5588_kpad
*kpad
, int ev_cnt
)
263 for (i
= 0; i
< ev_cnt
; i
++) {
264 int key
= adp5588_read(kpad
->client
, Key_EVENTA
+ i
);
265 int key_val
= key
& KEY_EV_MASK
;
267 if (key_val
>= GPI_PIN_BASE
&& key_val
<= GPI_PIN_END
) {
268 for (j
= 0; j
< kpad
->gpimapsize
; j
++) {
269 if (key_val
== kpad
->gpimap
[j
].pin
) {
270 input_report_switch(kpad
->input
,
271 kpad
->gpimap
[j
].sw_evt
,
272 key
& KEY_EV_PRESSED
);
277 input_report_key(kpad
->input
,
278 kpad
->keycode
[key_val
- 1],
279 key
& KEY_EV_PRESSED
);
284 static void adp5588_work(struct work_struct
*work
)
286 struct adp5588_kpad
*kpad
= container_of(work
,
287 struct adp5588_kpad
, work
.work
);
288 struct i2c_client
*client
= kpad
->client
;
291 status
= adp5588_read(client
, INT_STAT
);
293 if (status
& ADP5588_OVR_FLOW_INT
) /* Unlikely and should never happen */
294 dev_err(&client
->dev
, "Event Overflow Error\n");
296 if (status
& ADP5588_KE_INT
) {
297 ev_cnt
= adp5588_read(client
, KEY_LCK_EC_STAT
) & ADP5588_KEC
;
299 adp5588_report_events(kpad
, ev_cnt
);
300 input_sync(kpad
->input
);
303 adp5588_write(client
, INT_STAT
, status
); /* Status is W1C */
306 static irqreturn_t
adp5588_irq(int irq
, void *handle
)
308 struct adp5588_kpad
*kpad
= handle
;
311 * use keventd context to read the event fifo registers
312 * Schedule readout at least 25ms after notification for
316 schedule_delayed_work(&kpad
->work
, kpad
->delay
);
321 static int __devinit
adp5588_setup(struct i2c_client
*client
)
323 const struct adp5588_kpad_platform_data
*pdata
= client
->dev
.platform_data
;
324 const struct adp5588_gpio_platform_data
*gpio_data
= pdata
->gpio_data
;
326 unsigned char evt_mode1
= 0, evt_mode2
= 0, evt_mode3
= 0;
328 ret
= adp5588_write(client
, KP_GPIO1
, KP_SEL(pdata
->rows
));
329 ret
|= adp5588_write(client
, KP_GPIO2
, KP_SEL(pdata
->cols
) & 0xFF);
330 ret
|= adp5588_write(client
, KP_GPIO3
, KP_SEL(pdata
->cols
) >> 8);
332 if (pdata
->en_keylock
) {
333 ret
|= adp5588_write(client
, UNLOCK1
, pdata
->unlock_key1
);
334 ret
|= adp5588_write(client
, UNLOCK2
, pdata
->unlock_key2
);
335 ret
|= adp5588_write(client
, KEY_LCK_EC_STAT
, ADP5588_K_LCK_EN
);
338 for (i
= 0; i
< KEYP_MAX_EVENT
; i
++)
339 ret
|= adp5588_read(client
, Key_EVENTA
);
341 for (i
= 0; i
< pdata
->gpimapsize
; i
++) {
342 unsigned short pin
= pdata
->gpimap
[i
].pin
;
344 if (pin
<= GPI_PIN_ROW_END
) {
345 evt_mode1
|= (1 << (pin
- GPI_PIN_ROW_BASE
));
347 evt_mode2
|= ((1 << (pin
- GPI_PIN_COL_BASE
)) & 0xFF);
348 evt_mode3
|= ((1 << (pin
- GPI_PIN_COL_BASE
)) >> 8);
352 if (pdata
->gpimapsize
) {
353 ret
|= adp5588_write(client
, GPI_EM1
, evt_mode1
);
354 ret
|= adp5588_write(client
, GPI_EM2
, evt_mode2
);
355 ret
|= adp5588_write(client
, GPI_EM3
, evt_mode3
);
359 for (i
= 0; i
<= ADP5588_BANK(ADP5588_MAXGPIO
); i
++) {
360 int pull_mask
= gpio_data
->pullup_dis_mask
;
362 ret
|= adp5588_write(client
, GPIO_PULL1
+ i
,
363 (pull_mask
>> (8 * i
)) & 0xFF);
367 ret
|= adp5588_write(client
, INT_STAT
,
368 ADP5588_CMP2_INT
| ADP5588_CMP1_INT
|
369 ADP5588_OVR_FLOW_INT
| ADP5588_K_LCK_INT
|
370 ADP5588_GPI_INT
| ADP5588_KE_INT
); /* Status is W1C */
372 ret
|= adp5588_write(client
, CFG
, ADP5588_INT_CFG
|
373 ADP5588_OVR_FLOW_IEN
|
377 dev_err(&client
->dev
, "Write Error\n");
384 static void __devinit
adp5588_report_switch_state(struct adp5588_kpad
*kpad
)
386 int gpi_stat1
= adp5588_read(kpad
->client
, GPIO_DAT_STAT1
);
387 int gpi_stat2
= adp5588_read(kpad
->client
, GPIO_DAT_STAT2
);
388 int gpi_stat3
= adp5588_read(kpad
->client
, GPIO_DAT_STAT3
);
389 int gpi_stat_tmp
, pin_loc
;
392 for (i
= 0; i
< kpad
->gpimapsize
; i
++) {
393 unsigned short pin
= kpad
->gpimap
[i
].pin
;
395 if (pin
<= GPI_PIN_ROW_END
) {
396 gpi_stat_tmp
= gpi_stat1
;
397 pin_loc
= pin
- GPI_PIN_ROW_BASE
;
398 } else if ((pin
- GPI_PIN_COL_BASE
) < 8) {
399 gpi_stat_tmp
= gpi_stat2
;
400 pin_loc
= pin
- GPI_PIN_COL_BASE
;
402 gpi_stat_tmp
= gpi_stat3
;
403 pin_loc
= pin
- GPI_PIN_COL_BASE
- 8;
406 if (gpi_stat_tmp
< 0) {
407 dev_err(&kpad
->client
->dev
,
408 "Can't read GPIO_DAT_STAT switch %d default to OFF\n",
413 input_report_switch(kpad
->input
,
414 kpad
->gpimap
[i
].sw_evt
,
415 !(gpi_stat_tmp
& (1 << pin_loc
)));
418 input_sync(kpad
->input
);
422 static int __devinit
adp5588_probe(struct i2c_client
*client
,
423 const struct i2c_device_id
*id
)
425 struct adp5588_kpad
*kpad
;
426 const struct adp5588_kpad_platform_data
*pdata
= client
->dev
.platform_data
;
427 struct input_dev
*input
;
432 if (!i2c_check_functionality(client
->adapter
,
433 I2C_FUNC_SMBUS_BYTE_DATA
)) {
434 dev_err(&client
->dev
, "SMBUS Byte Data not Supported\n");
439 dev_err(&client
->dev
, "no platform data?\n");
443 if (!pdata
->rows
|| !pdata
->cols
|| !pdata
->keymap
) {
444 dev_err(&client
->dev
, "no rows, cols or keymap from pdata\n");
448 if (pdata
->keymapsize
!= ADP5588_KEYMAPSIZE
) {
449 dev_err(&client
->dev
, "invalid keymapsize\n");
453 if (!pdata
->gpimap
&& pdata
->gpimapsize
) {
454 dev_err(&client
->dev
, "invalid gpimap from pdata\n");
458 if (pdata
->gpimapsize
> ADP5588_GPIMAPSIZE_MAX
) {
459 dev_err(&client
->dev
, "invalid gpimapsize\n");
463 for (i
= 0; i
< pdata
->gpimapsize
; i
++) {
464 unsigned short pin
= pdata
->gpimap
[i
].pin
;
466 if (pin
< GPI_PIN_BASE
|| pin
> GPI_PIN_END
) {
467 dev_err(&client
->dev
, "invalid gpi pin data\n");
471 if (pin
<= GPI_PIN_ROW_END
) {
472 if (pin
- GPI_PIN_ROW_BASE
+ 1 <= pdata
->rows
) {
473 dev_err(&client
->dev
, "invalid gpi row data\n");
477 if (pin
- GPI_PIN_COL_BASE
+ 1 <= pdata
->cols
) {
478 dev_err(&client
->dev
, "invalid gpi col data\n");
485 dev_err(&client
->dev
, "no IRQ?\n");
489 kpad
= kzalloc(sizeof(*kpad
), GFP_KERNEL
);
490 input
= input_allocate_device();
491 if (!kpad
|| !input
) {
496 kpad
->client
= client
;
498 INIT_DELAYED_WORK(&kpad
->work
, adp5588_work
);
500 ret
= adp5588_read(client
, DEV_ID
);
506 revid
= (u8
) ret
& ADP5588_DEVICE_ID_MASK
;
507 if (WA_DELAYED_READOUT_REVID(revid
))
508 kpad
->delay
= msecs_to_jiffies(30);
510 input
->name
= client
->name
;
511 input
->phys
= "adp5588-keys/input0";
512 input
->dev
.parent
= &client
->dev
;
514 input_set_drvdata(input
, kpad
);
516 input
->id
.bustype
= BUS_I2C
;
517 input
->id
.vendor
= 0x0001;
518 input
->id
.product
= 0x0001;
519 input
->id
.version
= revid
;
521 input
->keycodesize
= sizeof(kpad
->keycode
[0]);
522 input
->keycodemax
= pdata
->keymapsize
;
523 input
->keycode
= kpad
->keycode
;
525 memcpy(kpad
->keycode
, pdata
->keymap
,
526 pdata
->keymapsize
* input
->keycodesize
);
528 kpad
->gpimap
= pdata
->gpimap
;
529 kpad
->gpimapsize
= pdata
->gpimapsize
;
531 /* setup input device */
532 __set_bit(EV_KEY
, input
->evbit
);
535 __set_bit(EV_REP
, input
->evbit
);
537 for (i
= 0; i
< input
->keycodemax
; i
++)
538 __set_bit(kpad
->keycode
[i
] & KEY_MAX
, input
->keybit
);
539 __clear_bit(KEY_RESERVED
, input
->keybit
);
541 if (kpad
->gpimapsize
)
542 __set_bit(EV_SW
, input
->evbit
);
543 for (i
= 0; i
< kpad
->gpimapsize
; i
++)
544 __set_bit(kpad
->gpimap
[i
].sw_evt
, input
->swbit
);
546 error
= input_register_device(input
);
548 dev_err(&client
->dev
, "unable to register input device\n");
552 error
= request_irq(client
->irq
, adp5588_irq
,
553 IRQF_TRIGGER_FALLING
,
554 client
->dev
.driver
->name
, kpad
);
556 dev_err(&client
->dev
, "irq %d busy?\n", client
->irq
);
560 error
= adp5588_setup(client
);
564 if (kpad
->gpimapsize
)
565 adp5588_report_switch_state(kpad
);
567 error
= adp5588_gpio_add(kpad
);
571 device_init_wakeup(&client
->dev
, 1);
572 i2c_set_clientdata(client
, kpad
);
574 dev_info(&client
->dev
, "Rev.%d keypad, irq %d\n", revid
, client
->irq
);
578 free_irq(client
->irq
, kpad
);
580 input_unregister_device(input
);
583 input_free_device(input
);
589 static int __devexit
adp5588_remove(struct i2c_client
*client
)
591 struct adp5588_kpad
*kpad
= i2c_get_clientdata(client
);
593 adp5588_write(client
, CFG
, 0);
594 free_irq(client
->irq
, kpad
);
595 cancel_delayed_work_sync(&kpad
->work
);
596 input_unregister_device(kpad
->input
);
597 adp5588_gpio_remove(kpad
);
604 static int adp5588_suspend(struct device
*dev
)
606 struct adp5588_kpad
*kpad
= dev_get_drvdata(dev
);
607 struct i2c_client
*client
= kpad
->client
;
609 disable_irq(client
->irq
);
610 cancel_delayed_work_sync(&kpad
->work
);
612 if (device_may_wakeup(&client
->dev
))
613 enable_irq_wake(client
->irq
);
618 static int adp5588_resume(struct device
*dev
)
620 struct adp5588_kpad
*kpad
= dev_get_drvdata(dev
);
621 struct i2c_client
*client
= kpad
->client
;
623 if (device_may_wakeup(&client
->dev
))
624 disable_irq_wake(client
->irq
);
626 enable_irq(client
->irq
);
631 static const struct dev_pm_ops adp5588_dev_pm_ops
= {
632 .suspend
= adp5588_suspend
,
633 .resume
= adp5588_resume
,
637 static const struct i2c_device_id adp5588_id
[] = {
638 { "adp5588-keys", 0 },
639 { "adp5587-keys", 0 },
642 MODULE_DEVICE_TABLE(i2c
, adp5588_id
);
644 static struct i2c_driver adp5588_driver
= {
646 .name
= KBUILD_MODNAME
,
648 .pm
= &adp5588_dev_pm_ops
,
651 .probe
= adp5588_probe
,
652 .remove
= __devexit_p(adp5588_remove
),
653 .id_table
= adp5588_id
,
656 module_i2c_driver(adp5588_driver
);
658 MODULE_LICENSE("GPL");
659 MODULE_AUTHOR("Michael Hennerich <hennerich@blackfin.uclinux.org>");
660 MODULE_DESCRIPTION("ADP5588/87 Keypad driver");