Loading...
1// SPDX-License-Identifier: GPL-2.0-only
2/* Copyright (c) 2009-2011, Code Aurora Forum. All rights reserved.
3 */
4
5#include <linux/module.h>
6#include <linux/platform_device.h>
7#include <linux/kernel.h>
8#include <linux/interrupt.h>
9#include <linux/slab.h>
10#include <linux/input.h>
11#include <linux/bitops.h>
12#include <linux/delay.h>
13#include <linux/mutex.h>
14#include <linux/regmap.h>
15#include <linux/of.h>
16#include <linux/input/matrix_keypad.h>
17
18#define PM8XXX_MAX_ROWS 18
19#define PM8XXX_MAX_COLS 8
20#define PM8XXX_ROW_SHIFT 3
21#define PM8XXX_MATRIX_MAX_SIZE (PM8XXX_MAX_ROWS * PM8XXX_MAX_COLS)
22
23#define PM8XXX_MIN_ROWS 5
24#define PM8XXX_MIN_COLS 5
25
26#define MAX_SCAN_DELAY 128
27#define MIN_SCAN_DELAY 1
28
29/* in nanoseconds */
30#define MAX_ROW_HOLD_DELAY 122000
31#define MIN_ROW_HOLD_DELAY 30500
32
33#define MAX_DEBOUNCE_TIME 20
34#define MIN_DEBOUNCE_TIME 5
35
36#define KEYP_CTRL 0x148
37
38#define KEYP_CTRL_EVNTS BIT(0)
39#define KEYP_CTRL_EVNTS_MASK 0x3
40
41#define KEYP_CTRL_SCAN_COLS_SHIFT 5
42#define KEYP_CTRL_SCAN_COLS_MIN 5
43#define KEYP_CTRL_SCAN_COLS_BITS 0x3
44
45#define KEYP_CTRL_SCAN_ROWS_SHIFT 2
46#define KEYP_CTRL_SCAN_ROWS_MIN 5
47#define KEYP_CTRL_SCAN_ROWS_BITS 0x7
48
49#define KEYP_CTRL_KEYP_EN BIT(7)
50
51#define KEYP_SCAN 0x149
52
53#define KEYP_SCAN_READ_STATE BIT(0)
54#define KEYP_SCAN_DBOUNCE_SHIFT 1
55#define KEYP_SCAN_PAUSE_SHIFT 3
56#define KEYP_SCAN_ROW_HOLD_SHIFT 6
57
58#define KEYP_TEST 0x14A
59
60#define KEYP_TEST_CLEAR_RECENT_SCAN BIT(6)
61#define KEYP_TEST_CLEAR_OLD_SCAN BIT(5)
62#define KEYP_TEST_READ_RESET BIT(4)
63#define KEYP_TEST_DTEST_EN BIT(3)
64#define KEYP_TEST_ABORT_READ BIT(0)
65
66#define KEYP_TEST_DBG_SELECT_SHIFT 1
67
68/* bits of these registers represent
69 * '0' for key press
70 * '1' for key release
71 */
72#define KEYP_RECENT_DATA 0x14B
73#define KEYP_OLD_DATA 0x14C
74
75#define KEYP_CLOCK_FREQ 32768
76
77/**
78 * struct pmic8xxx_kp - internal keypad data structure
79 * @num_cols: number of columns of keypad
80 * @num_rows: number of row of keypad
81 * @input: input device pointer for keypad
82 * @regmap: regmap handle
83 * @key_sense_irq: key press/release irq number
84 * @key_stuck_irq: key stuck notification irq number
85 * @keycodes: array to hold the key codes
86 * @dev: parent device pointer
87 * @keystate: present key press/release state
88 * @stuckstate: present state when key stuck irq
89 * @ctrl_reg: control register value
90 */
91struct pmic8xxx_kp {
92 unsigned int num_rows;
93 unsigned int num_cols;
94 struct input_dev *input;
95 struct regmap *regmap;
96 int key_sense_irq;
97 int key_stuck_irq;
98
99 unsigned short keycodes[PM8XXX_MATRIX_MAX_SIZE];
100
101 struct device *dev;
102 u16 keystate[PM8XXX_MAX_ROWS];
103 u16 stuckstate[PM8XXX_MAX_ROWS];
104
105 u8 ctrl_reg;
106};
107
108static u8 pmic8xxx_col_state(struct pmic8xxx_kp *kp, u8 col)
109{
110 /* all keys pressed on that particular row? */
111 if (col == 0x00)
112 return 1 << kp->num_cols;
113 else
114 return col & ((1 << kp->num_cols) - 1);
115}
116
117/*
118 * Synchronous read protocol for RevB0 onwards:
119 *
120 * 1. Write '1' to ReadState bit in KEYP_SCAN register
121 * 2. Wait 2*32KHz clocks, so that HW can successfully enter read mode
122 * synchronously
123 * 3. Read rows in old array first if events are more than one
124 * 4. Read rows in recent array
125 * 5. Wait 4*32KHz clocks
126 * 6. Write '0' to ReadState bit of KEYP_SCAN register so that hw can
127 * synchronously exit read mode.
128 */
129static int pmic8xxx_chk_sync_read(struct pmic8xxx_kp *kp)
130{
131 int rc;
132 unsigned int scan_val;
133
134 rc = regmap_read(kp->regmap, KEYP_SCAN, &scan_val);
135 if (rc < 0) {
136 dev_err(kp->dev, "Error reading KEYP_SCAN reg, rc=%d\n", rc);
137 return rc;
138 }
139
140 scan_val |= 0x1;
141
142 rc = regmap_write(kp->regmap, KEYP_SCAN, scan_val);
143 if (rc < 0) {
144 dev_err(kp->dev, "Error writing KEYP_SCAN reg, rc=%d\n", rc);
145 return rc;
146 }
147
148 /* 2 * 32KHz clocks */
149 udelay((2 * DIV_ROUND_UP(USEC_PER_SEC, KEYP_CLOCK_FREQ)) + 1);
150
151 return rc;
152}
153
154static int pmic8xxx_kp_read_data(struct pmic8xxx_kp *kp, u16 *state,
155 u16 data_reg, int read_rows)
156{
157 int rc, row;
158 unsigned int val;
159
160 for (row = 0; row < read_rows; row++) {
161 rc = regmap_read(kp->regmap, data_reg, &val);
162 if (rc)
163 return rc;
164 dev_dbg(kp->dev, "%d = %d\n", row, val);
165 state[row] = pmic8xxx_col_state(kp, val);
166 }
167
168 return 0;
169}
170
171static int pmic8xxx_kp_read_matrix(struct pmic8xxx_kp *kp, u16 *new_state,
172 u16 *old_state)
173{
174 int rc, read_rows;
175 unsigned int scan_val;
176
177 if (kp->num_rows < PM8XXX_MIN_ROWS)
178 read_rows = PM8XXX_MIN_ROWS;
179 else
180 read_rows = kp->num_rows;
181
182 pmic8xxx_chk_sync_read(kp);
183
184 if (old_state) {
185 rc = pmic8xxx_kp_read_data(kp, old_state, KEYP_OLD_DATA,
186 read_rows);
187 if (rc < 0) {
188 dev_err(kp->dev,
189 "Error reading KEYP_OLD_DATA, rc=%d\n", rc);
190 return rc;
191 }
192 }
193
194 rc = pmic8xxx_kp_read_data(kp, new_state, KEYP_RECENT_DATA,
195 read_rows);
196 if (rc < 0) {
197 dev_err(kp->dev,
198 "Error reading KEYP_RECENT_DATA, rc=%d\n", rc);
199 return rc;
200 }
201
202 /* 4 * 32KHz clocks */
203 udelay((4 * DIV_ROUND_UP(USEC_PER_SEC, KEYP_CLOCK_FREQ)) + 1);
204
205 rc = regmap_read(kp->regmap, KEYP_SCAN, &scan_val);
206 if (rc < 0) {
207 dev_err(kp->dev, "Error reading KEYP_SCAN reg, rc=%d\n", rc);
208 return rc;
209 }
210
211 scan_val &= 0xFE;
212 rc = regmap_write(kp->regmap, KEYP_SCAN, scan_val);
213 if (rc < 0)
214 dev_err(kp->dev, "Error writing KEYP_SCAN reg, rc=%d\n", rc);
215
216 return rc;
217}
218
219static void __pmic8xxx_kp_scan_matrix(struct pmic8xxx_kp *kp, u16 *new_state,
220 u16 *old_state)
221{
222 int row, col, code;
223
224 for (row = 0; row < kp->num_rows; row++) {
225 int bits_changed = new_state[row] ^ old_state[row];
226
227 if (!bits_changed)
228 continue;
229
230 for (col = 0; col < kp->num_cols; col++) {
231 if (!(bits_changed & (1 << col)))
232 continue;
233
234 dev_dbg(kp->dev, "key [%d:%d] %s\n", row, col,
235 !(new_state[row] & (1 << col)) ?
236 "pressed" : "released");
237
238 code = MATRIX_SCAN_CODE(row, col, PM8XXX_ROW_SHIFT);
239
240 input_event(kp->input, EV_MSC, MSC_SCAN, code);
241 input_report_key(kp->input,
242 kp->keycodes[code],
243 !(new_state[row] & (1 << col)));
244
245 input_sync(kp->input);
246 }
247 }
248}
249
250static bool pmic8xxx_detect_ghost_keys(struct pmic8xxx_kp *kp, u16 *new_state)
251{
252 int row, found_first = -1;
253 u16 check, row_state;
254
255 check = 0;
256 for (row = 0; row < kp->num_rows; row++) {
257 row_state = (~new_state[row]) &
258 ((1 << kp->num_cols) - 1);
259
260 if (hweight16(row_state) > 1) {
261 if (found_first == -1)
262 found_first = row;
263 if (check & row_state) {
264 dev_dbg(kp->dev, "detected ghost key on row[%d]"
265 " and row[%d]\n", found_first, row);
266 return true;
267 }
268 }
269 check |= row_state;
270 }
271 return false;
272}
273
274static int pmic8xxx_kp_scan_matrix(struct pmic8xxx_kp *kp, unsigned int events)
275{
276 u16 new_state[PM8XXX_MAX_ROWS];
277 u16 old_state[PM8XXX_MAX_ROWS];
278 int rc;
279
280 switch (events) {
281 case 0x1:
282 rc = pmic8xxx_kp_read_matrix(kp, new_state, NULL);
283 if (rc < 0)
284 return rc;
285
286 /* detecting ghost key is not an error */
287 if (pmic8xxx_detect_ghost_keys(kp, new_state))
288 return 0;
289 __pmic8xxx_kp_scan_matrix(kp, new_state, kp->keystate);
290 memcpy(kp->keystate, new_state, sizeof(new_state));
291 break;
292 case 0x3: /* two events - eventcounter is gray-coded */
293 rc = pmic8xxx_kp_read_matrix(kp, new_state, old_state);
294 if (rc < 0)
295 return rc;
296
297 __pmic8xxx_kp_scan_matrix(kp, old_state, kp->keystate);
298 __pmic8xxx_kp_scan_matrix(kp, new_state, old_state);
299 memcpy(kp->keystate, new_state, sizeof(new_state));
300 break;
301 case 0x2:
302 dev_dbg(kp->dev, "Some key events were lost\n");
303 rc = pmic8xxx_kp_read_matrix(kp, new_state, old_state);
304 if (rc < 0)
305 return rc;
306 __pmic8xxx_kp_scan_matrix(kp, old_state, kp->keystate);
307 __pmic8xxx_kp_scan_matrix(kp, new_state, old_state);
308 memcpy(kp->keystate, new_state, sizeof(new_state));
309 break;
310 default:
311 rc = -EINVAL;
312 }
313 return rc;
314}
315
316/*
317 * NOTE: We are reading recent and old data registers blindly
318 * whenever key-stuck interrupt happens, because events counter doesn't
319 * get updated when this interrupt happens due to key stuck doesn't get
320 * considered as key state change.
321 *
322 * We are not using old data register contents after they are being read
323 * because it might report the key which was pressed before the key being stuck
324 * as stuck key because it's pressed status is stored in the old data
325 * register.
326 */
327static irqreturn_t pmic8xxx_kp_stuck_irq(int irq, void *data)
328{
329 u16 new_state[PM8XXX_MAX_ROWS];
330 u16 old_state[PM8XXX_MAX_ROWS];
331 int rc;
332 struct pmic8xxx_kp *kp = data;
333
334 rc = pmic8xxx_kp_read_matrix(kp, new_state, old_state);
335 if (rc < 0) {
336 dev_err(kp->dev, "failed to read keypad matrix\n");
337 return IRQ_HANDLED;
338 }
339
340 __pmic8xxx_kp_scan_matrix(kp, new_state, kp->stuckstate);
341
342 return IRQ_HANDLED;
343}
344
345static irqreturn_t pmic8xxx_kp_irq(int irq, void *data)
346{
347 struct pmic8xxx_kp *kp = data;
348 unsigned int ctrl_val, events;
349 int rc;
350
351 rc = regmap_read(kp->regmap, KEYP_CTRL, &ctrl_val);
352 if (rc < 0) {
353 dev_err(kp->dev, "failed to read keyp_ctrl register\n");
354 return IRQ_HANDLED;
355 }
356
357 events = ctrl_val & KEYP_CTRL_EVNTS_MASK;
358
359 rc = pmic8xxx_kp_scan_matrix(kp, events);
360 if (rc < 0)
361 dev_err(kp->dev, "failed to scan matrix\n");
362
363 return IRQ_HANDLED;
364}
365
366static int pmic8xxx_kpd_init(struct pmic8xxx_kp *kp,
367 struct platform_device *pdev)
368{
369 const struct device_node *of_node = pdev->dev.of_node;
370 unsigned int scan_delay_ms;
371 unsigned int row_hold_ns;
372 unsigned int debounce_ms;
373 int bits, rc, cycles;
374 u8 scan_val = 0, ctrl_val = 0;
375 static const u8 row_bits[] = {
376 0, 1, 2, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7,
377 };
378
379 /* Find column bits */
380 if (kp->num_cols < KEYP_CTRL_SCAN_COLS_MIN)
381 bits = 0;
382 else
383 bits = kp->num_cols - KEYP_CTRL_SCAN_COLS_MIN;
384 ctrl_val = (bits & KEYP_CTRL_SCAN_COLS_BITS) <<
385 KEYP_CTRL_SCAN_COLS_SHIFT;
386
387 /* Find row bits */
388 if (kp->num_rows < KEYP_CTRL_SCAN_ROWS_MIN)
389 bits = 0;
390 else
391 bits = row_bits[kp->num_rows - KEYP_CTRL_SCAN_ROWS_MIN];
392
393 ctrl_val |= (bits << KEYP_CTRL_SCAN_ROWS_SHIFT);
394
395 rc = regmap_write(kp->regmap, KEYP_CTRL, ctrl_val);
396 if (rc < 0) {
397 dev_err(kp->dev, "Error writing KEYP_CTRL reg, rc=%d\n", rc);
398 return rc;
399 }
400
401 if (of_property_read_u32(of_node, "scan-delay", &scan_delay_ms))
402 scan_delay_ms = MIN_SCAN_DELAY;
403
404 if (scan_delay_ms > MAX_SCAN_DELAY || scan_delay_ms < MIN_SCAN_DELAY ||
405 !is_power_of_2(scan_delay_ms)) {
406 dev_err(&pdev->dev, "invalid keypad scan time supplied\n");
407 return -EINVAL;
408 }
409
410 if (of_property_read_u32(of_node, "row-hold", &row_hold_ns))
411 row_hold_ns = MIN_ROW_HOLD_DELAY;
412
413 if (row_hold_ns > MAX_ROW_HOLD_DELAY ||
414 row_hold_ns < MIN_ROW_HOLD_DELAY ||
415 ((row_hold_ns % MIN_ROW_HOLD_DELAY) != 0)) {
416 dev_err(&pdev->dev, "invalid keypad row hold time supplied\n");
417 return -EINVAL;
418 }
419
420 if (of_property_read_u32(of_node, "debounce", &debounce_ms))
421 debounce_ms = MIN_DEBOUNCE_TIME;
422
423 if (((debounce_ms % 5) != 0) ||
424 debounce_ms > MAX_DEBOUNCE_TIME ||
425 debounce_ms < MIN_DEBOUNCE_TIME) {
426 dev_err(&pdev->dev, "invalid debounce time supplied\n");
427 return -EINVAL;
428 }
429
430 bits = (debounce_ms / 5) - 1;
431
432 scan_val |= (bits << KEYP_SCAN_DBOUNCE_SHIFT);
433
434 bits = fls(scan_delay_ms) - 1;
435 scan_val |= (bits << KEYP_SCAN_PAUSE_SHIFT);
436
437 /* Row hold time is a multiple of 32KHz cycles. */
438 cycles = (row_hold_ns * KEYP_CLOCK_FREQ) / NSEC_PER_SEC;
439
440 scan_val |= (cycles << KEYP_SCAN_ROW_HOLD_SHIFT);
441
442 rc = regmap_write(kp->regmap, KEYP_SCAN, scan_val);
443 if (rc)
444 dev_err(kp->dev, "Error writing KEYP_SCAN reg, rc=%d\n", rc);
445
446 return rc;
447
448}
449
450static int pmic8xxx_kp_enable(struct pmic8xxx_kp *kp)
451{
452 int rc;
453
454 kp->ctrl_reg |= KEYP_CTRL_KEYP_EN;
455
456 rc = regmap_write(kp->regmap, KEYP_CTRL, kp->ctrl_reg);
457 if (rc < 0)
458 dev_err(kp->dev, "Error writing KEYP_CTRL reg, rc=%d\n", rc);
459
460 return rc;
461}
462
463static int pmic8xxx_kp_disable(struct pmic8xxx_kp *kp)
464{
465 int rc;
466
467 kp->ctrl_reg &= ~KEYP_CTRL_KEYP_EN;
468
469 rc = regmap_write(kp->regmap, KEYP_CTRL, kp->ctrl_reg);
470 if (rc < 0)
471 return rc;
472
473 return rc;
474}
475
476static int pmic8xxx_kp_open(struct input_dev *dev)
477{
478 struct pmic8xxx_kp *kp = input_get_drvdata(dev);
479
480 return pmic8xxx_kp_enable(kp);
481}
482
483static void pmic8xxx_kp_close(struct input_dev *dev)
484{
485 struct pmic8xxx_kp *kp = input_get_drvdata(dev);
486
487 pmic8xxx_kp_disable(kp);
488}
489
490/*
491 * keypad controller should be initialized in the following sequence
492 * only, otherwise it might get into FSM stuck state.
493 *
494 * - Initialize keypad control parameters, like no. of rows, columns,
495 * timing values etc.,
496 * - configure rows and column gpios pull up/down.
497 * - set irq edge type.
498 * - enable the keypad controller.
499 */
500static int pmic8xxx_kp_probe(struct platform_device *pdev)
501{
502 struct device_node *np = pdev->dev.of_node;
503 unsigned int rows, cols;
504 bool repeat;
505 bool wakeup;
506 struct pmic8xxx_kp *kp;
507 int rc;
508 unsigned int ctrl_val;
509
510 rc = matrix_keypad_parse_properties(&pdev->dev, &rows, &cols);
511 if (rc)
512 return rc;
513
514 if (cols > PM8XXX_MAX_COLS || rows > PM8XXX_MAX_ROWS ||
515 cols < PM8XXX_MIN_COLS) {
516 dev_err(&pdev->dev, "invalid platform data\n");
517 return -EINVAL;
518 }
519
520 repeat = !of_property_read_bool(np, "linux,input-no-autorepeat");
521
522 wakeup = of_property_read_bool(np, "wakeup-source") ||
523 /* legacy name */
524 of_property_read_bool(np, "linux,keypad-wakeup");
525
526 kp = devm_kzalloc(&pdev->dev, sizeof(*kp), GFP_KERNEL);
527 if (!kp)
528 return -ENOMEM;
529
530 kp->regmap = dev_get_regmap(pdev->dev.parent, NULL);
531 if (!kp->regmap)
532 return -ENODEV;
533
534 platform_set_drvdata(pdev, kp);
535
536 kp->num_rows = rows;
537 kp->num_cols = cols;
538 kp->dev = &pdev->dev;
539
540 kp->input = devm_input_allocate_device(&pdev->dev);
541 if (!kp->input) {
542 dev_err(&pdev->dev, "unable to allocate input device\n");
543 return -ENOMEM;
544 }
545
546 kp->key_sense_irq = platform_get_irq(pdev, 0);
547 if (kp->key_sense_irq < 0)
548 return kp->key_sense_irq;
549
550 kp->key_stuck_irq = platform_get_irq(pdev, 1);
551 if (kp->key_stuck_irq < 0)
552 return kp->key_stuck_irq;
553
554 kp->input->name = "PMIC8XXX keypad";
555 kp->input->phys = "pmic8xxx_keypad/input0";
556
557 kp->input->id.bustype = BUS_I2C;
558 kp->input->id.version = 0x0001;
559 kp->input->id.product = 0x0001;
560 kp->input->id.vendor = 0x0001;
561
562 kp->input->open = pmic8xxx_kp_open;
563 kp->input->close = pmic8xxx_kp_close;
564
565 rc = matrix_keypad_build_keymap(NULL, NULL,
566 PM8XXX_MAX_ROWS, PM8XXX_MAX_COLS,
567 kp->keycodes, kp->input);
568 if (rc) {
569 dev_err(&pdev->dev, "failed to build keymap\n");
570 return rc;
571 }
572
573 if (repeat)
574 __set_bit(EV_REP, kp->input->evbit);
575 input_set_capability(kp->input, EV_MSC, MSC_SCAN);
576
577 input_set_drvdata(kp->input, kp);
578
579 /* initialize keypad state */
580 memset(kp->keystate, 0xff, sizeof(kp->keystate));
581 memset(kp->stuckstate, 0xff, sizeof(kp->stuckstate));
582
583 rc = pmic8xxx_kpd_init(kp, pdev);
584 if (rc < 0) {
585 dev_err(&pdev->dev, "unable to initialize keypad controller\n");
586 return rc;
587 }
588
589 rc = devm_request_any_context_irq(&pdev->dev, kp->key_sense_irq,
590 pmic8xxx_kp_irq, IRQF_TRIGGER_RISING, "pmic-keypad",
591 kp);
592 if (rc < 0) {
593 dev_err(&pdev->dev, "failed to request keypad sense irq\n");
594 return rc;
595 }
596
597 rc = devm_request_any_context_irq(&pdev->dev, kp->key_stuck_irq,
598 pmic8xxx_kp_stuck_irq, IRQF_TRIGGER_RISING,
599 "pmic-keypad-stuck", kp);
600 if (rc < 0) {
601 dev_err(&pdev->dev, "failed to request keypad stuck irq\n");
602 return rc;
603 }
604
605 rc = regmap_read(kp->regmap, KEYP_CTRL, &ctrl_val);
606 if (rc < 0) {
607 dev_err(&pdev->dev, "failed to read KEYP_CTRL register\n");
608 return rc;
609 }
610
611 kp->ctrl_reg = ctrl_val;
612
613 rc = input_register_device(kp->input);
614 if (rc < 0) {
615 dev_err(&pdev->dev, "unable to register keypad input device\n");
616 return rc;
617 }
618
619 device_init_wakeup(&pdev->dev, wakeup);
620
621 return 0;
622}
623
624static int pmic8xxx_kp_suspend(struct device *dev)
625{
626 struct platform_device *pdev = to_platform_device(dev);
627 struct pmic8xxx_kp *kp = platform_get_drvdata(pdev);
628 struct input_dev *input_dev = kp->input;
629
630 if (device_may_wakeup(dev)) {
631 enable_irq_wake(kp->key_sense_irq);
632 } else {
633 mutex_lock(&input_dev->mutex);
634
635 if (input_device_enabled(input_dev))
636 pmic8xxx_kp_disable(kp);
637
638 mutex_unlock(&input_dev->mutex);
639 }
640
641 return 0;
642}
643
644static int pmic8xxx_kp_resume(struct device *dev)
645{
646 struct platform_device *pdev = to_platform_device(dev);
647 struct pmic8xxx_kp *kp = platform_get_drvdata(pdev);
648 struct input_dev *input_dev = kp->input;
649
650 if (device_may_wakeup(dev)) {
651 disable_irq_wake(kp->key_sense_irq);
652 } else {
653 mutex_lock(&input_dev->mutex);
654
655 if (input_device_enabled(input_dev))
656 pmic8xxx_kp_enable(kp);
657
658 mutex_unlock(&input_dev->mutex);
659 }
660
661 return 0;
662}
663
664static DEFINE_SIMPLE_DEV_PM_OPS(pm8xxx_kp_pm_ops,
665 pmic8xxx_kp_suspend, pmic8xxx_kp_resume);
666
667static const struct of_device_id pm8xxx_match_table[] = {
668 { .compatible = "qcom,pm8058-keypad" },
669 { .compatible = "qcom,pm8921-keypad" },
670 { }
671};
672MODULE_DEVICE_TABLE(of, pm8xxx_match_table);
673
674static struct platform_driver pmic8xxx_kp_driver = {
675 .probe = pmic8xxx_kp_probe,
676 .driver = {
677 .name = "pm8xxx-keypad",
678 .pm = pm_sleep_ptr(&pm8xxx_kp_pm_ops),
679 .of_match_table = pm8xxx_match_table,
680 },
681};
682module_platform_driver(pmic8xxx_kp_driver);
683
684MODULE_LICENSE("GPL v2");
685MODULE_DESCRIPTION("PMIC8XXX keypad driver");
686MODULE_ALIAS("platform:pmic8xxx_keypad");
687MODULE_AUTHOR("Trilok Soni <tsoni@codeaurora.org>");
1/* Copyright (c) 2009-2011, Code Aurora Forum. All rights reserved.
2 *
3 * This program is free software; you can redistribute it and/or modify
4 * it under the terms of the GNU General Public License version 2 and
5 * only version 2 as published by the Free Software Foundation.
6 *
7 * This program is distributed in the hope that it will be useful,
8 * but WITHOUT ANY WARRANTY; without even the implied warranty of
9 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
10 * GNU General Public License for more details.
11 */
12
13#include <linux/module.h>
14#include <linux/platform_device.h>
15#include <linux/kernel.h>
16#include <linux/interrupt.h>
17#include <linux/slab.h>
18#include <linux/input.h>
19#include <linux/bitops.h>
20#include <linux/delay.h>
21#include <linux/mutex.h>
22#include <linux/regmap.h>
23#include <linux/of.h>
24#include <linux/input/matrix_keypad.h>
25
26#define PM8XXX_MAX_ROWS 18
27#define PM8XXX_MAX_COLS 8
28#define PM8XXX_ROW_SHIFT 3
29#define PM8XXX_MATRIX_MAX_SIZE (PM8XXX_MAX_ROWS * PM8XXX_MAX_COLS)
30
31#define PM8XXX_MIN_ROWS 5
32#define PM8XXX_MIN_COLS 5
33
34#define MAX_SCAN_DELAY 128
35#define MIN_SCAN_DELAY 1
36
37/* in nanoseconds */
38#define MAX_ROW_HOLD_DELAY 122000
39#define MIN_ROW_HOLD_DELAY 30500
40
41#define MAX_DEBOUNCE_TIME 20
42#define MIN_DEBOUNCE_TIME 5
43
44#define KEYP_CTRL 0x148
45
46#define KEYP_CTRL_EVNTS BIT(0)
47#define KEYP_CTRL_EVNTS_MASK 0x3
48
49#define KEYP_CTRL_SCAN_COLS_SHIFT 5
50#define KEYP_CTRL_SCAN_COLS_MIN 5
51#define KEYP_CTRL_SCAN_COLS_BITS 0x3
52
53#define KEYP_CTRL_SCAN_ROWS_SHIFT 2
54#define KEYP_CTRL_SCAN_ROWS_MIN 5
55#define KEYP_CTRL_SCAN_ROWS_BITS 0x7
56
57#define KEYP_CTRL_KEYP_EN BIT(7)
58
59#define KEYP_SCAN 0x149
60
61#define KEYP_SCAN_READ_STATE BIT(0)
62#define KEYP_SCAN_DBOUNCE_SHIFT 1
63#define KEYP_SCAN_PAUSE_SHIFT 3
64#define KEYP_SCAN_ROW_HOLD_SHIFT 6
65
66#define KEYP_TEST 0x14A
67
68#define KEYP_TEST_CLEAR_RECENT_SCAN BIT(6)
69#define KEYP_TEST_CLEAR_OLD_SCAN BIT(5)
70#define KEYP_TEST_READ_RESET BIT(4)
71#define KEYP_TEST_DTEST_EN BIT(3)
72#define KEYP_TEST_ABORT_READ BIT(0)
73
74#define KEYP_TEST_DBG_SELECT_SHIFT 1
75
76/* bits of these registers represent
77 * '0' for key press
78 * '1' for key release
79 */
80#define KEYP_RECENT_DATA 0x14B
81#define KEYP_OLD_DATA 0x14C
82
83#define KEYP_CLOCK_FREQ 32768
84
85/**
86 * struct pmic8xxx_kp - internal keypad data structure
87 * @num_cols - number of columns of keypad
88 * @num_rows - number of row of keypad
89 * @input - input device pointer for keypad
90 * @regmap - regmap handle
91 * @key_sense_irq - key press/release irq number
92 * @key_stuck_irq - key stuck notification irq number
93 * @keycodes - array to hold the key codes
94 * @dev - parent device pointer
95 * @keystate - present key press/release state
96 * @stuckstate - present state when key stuck irq
97 * @ctrl_reg - control register value
98 */
99struct pmic8xxx_kp {
100 unsigned int num_rows;
101 unsigned int num_cols;
102 struct input_dev *input;
103 struct regmap *regmap;
104 int key_sense_irq;
105 int key_stuck_irq;
106
107 unsigned short keycodes[PM8XXX_MATRIX_MAX_SIZE];
108
109 struct device *dev;
110 u16 keystate[PM8XXX_MAX_ROWS];
111 u16 stuckstate[PM8XXX_MAX_ROWS];
112
113 u8 ctrl_reg;
114};
115
116static u8 pmic8xxx_col_state(struct pmic8xxx_kp *kp, u8 col)
117{
118 /* all keys pressed on that particular row? */
119 if (col == 0x00)
120 return 1 << kp->num_cols;
121 else
122 return col & ((1 << kp->num_cols) - 1);
123}
124
125/*
126 * Synchronous read protocol for RevB0 onwards:
127 *
128 * 1. Write '1' to ReadState bit in KEYP_SCAN register
129 * 2. Wait 2*32KHz clocks, so that HW can successfully enter read mode
130 * synchronously
131 * 3. Read rows in old array first if events are more than one
132 * 4. Read rows in recent array
133 * 5. Wait 4*32KHz clocks
134 * 6. Write '0' to ReadState bit of KEYP_SCAN register so that hw can
135 * synchronously exit read mode.
136 */
137static int pmic8xxx_chk_sync_read(struct pmic8xxx_kp *kp)
138{
139 int rc;
140 unsigned int scan_val;
141
142 rc = regmap_read(kp->regmap, KEYP_SCAN, &scan_val);
143 if (rc < 0) {
144 dev_err(kp->dev, "Error reading KEYP_SCAN reg, rc=%d\n", rc);
145 return rc;
146 }
147
148 scan_val |= 0x1;
149
150 rc = regmap_write(kp->regmap, KEYP_SCAN, scan_val);
151 if (rc < 0) {
152 dev_err(kp->dev, "Error writing KEYP_SCAN reg, rc=%d\n", rc);
153 return rc;
154 }
155
156 /* 2 * 32KHz clocks */
157 udelay((2 * DIV_ROUND_UP(USEC_PER_SEC, KEYP_CLOCK_FREQ)) + 1);
158
159 return rc;
160}
161
162static int pmic8xxx_kp_read_data(struct pmic8xxx_kp *kp, u16 *state,
163 u16 data_reg, int read_rows)
164{
165 int rc, row;
166 unsigned int val;
167
168 for (row = 0; row < read_rows; row++) {
169 rc = regmap_read(kp->regmap, data_reg, &val);
170 if (rc)
171 return rc;
172 dev_dbg(kp->dev, "%d = %d\n", row, val);
173 state[row] = pmic8xxx_col_state(kp, val);
174 }
175
176 return 0;
177}
178
179static int pmic8xxx_kp_read_matrix(struct pmic8xxx_kp *kp, u16 *new_state,
180 u16 *old_state)
181{
182 int rc, read_rows;
183 unsigned int scan_val;
184
185 if (kp->num_rows < PM8XXX_MIN_ROWS)
186 read_rows = PM8XXX_MIN_ROWS;
187 else
188 read_rows = kp->num_rows;
189
190 pmic8xxx_chk_sync_read(kp);
191
192 if (old_state) {
193 rc = pmic8xxx_kp_read_data(kp, old_state, KEYP_OLD_DATA,
194 read_rows);
195 if (rc < 0) {
196 dev_err(kp->dev,
197 "Error reading KEYP_OLD_DATA, rc=%d\n", rc);
198 return rc;
199 }
200 }
201
202 rc = pmic8xxx_kp_read_data(kp, new_state, KEYP_RECENT_DATA,
203 read_rows);
204 if (rc < 0) {
205 dev_err(kp->dev,
206 "Error reading KEYP_RECENT_DATA, rc=%d\n", rc);
207 return rc;
208 }
209
210 /* 4 * 32KHz clocks */
211 udelay((4 * DIV_ROUND_UP(USEC_PER_SEC, KEYP_CLOCK_FREQ)) + 1);
212
213 rc = regmap_read(kp->regmap, KEYP_SCAN, &scan_val);
214 if (rc < 0) {
215 dev_err(kp->dev, "Error reading KEYP_SCAN reg, rc=%d\n", rc);
216 return rc;
217 }
218
219 scan_val &= 0xFE;
220 rc = regmap_write(kp->regmap, KEYP_SCAN, scan_val);
221 if (rc < 0)
222 dev_err(kp->dev, "Error writing KEYP_SCAN reg, rc=%d\n", rc);
223
224 return rc;
225}
226
227static void __pmic8xxx_kp_scan_matrix(struct pmic8xxx_kp *kp, u16 *new_state,
228 u16 *old_state)
229{
230 int row, col, code;
231
232 for (row = 0; row < kp->num_rows; row++) {
233 int bits_changed = new_state[row] ^ old_state[row];
234
235 if (!bits_changed)
236 continue;
237
238 for (col = 0; col < kp->num_cols; col++) {
239 if (!(bits_changed & (1 << col)))
240 continue;
241
242 dev_dbg(kp->dev, "key [%d:%d] %s\n", row, col,
243 !(new_state[row] & (1 << col)) ?
244 "pressed" : "released");
245
246 code = MATRIX_SCAN_CODE(row, col, PM8XXX_ROW_SHIFT);
247
248 input_event(kp->input, EV_MSC, MSC_SCAN, code);
249 input_report_key(kp->input,
250 kp->keycodes[code],
251 !(new_state[row] & (1 << col)));
252
253 input_sync(kp->input);
254 }
255 }
256}
257
258static bool pmic8xxx_detect_ghost_keys(struct pmic8xxx_kp *kp, u16 *new_state)
259{
260 int row, found_first = -1;
261 u16 check, row_state;
262
263 check = 0;
264 for (row = 0; row < kp->num_rows; row++) {
265 row_state = (~new_state[row]) &
266 ((1 << kp->num_cols) - 1);
267
268 if (hweight16(row_state) > 1) {
269 if (found_first == -1)
270 found_first = row;
271 if (check & row_state) {
272 dev_dbg(kp->dev, "detected ghost key on row[%d]"
273 " and row[%d]\n", found_first, row);
274 return true;
275 }
276 }
277 check |= row_state;
278 }
279 return false;
280}
281
282static int pmic8xxx_kp_scan_matrix(struct pmic8xxx_kp *kp, unsigned int events)
283{
284 u16 new_state[PM8XXX_MAX_ROWS];
285 u16 old_state[PM8XXX_MAX_ROWS];
286 int rc;
287
288 switch (events) {
289 case 0x1:
290 rc = pmic8xxx_kp_read_matrix(kp, new_state, NULL);
291 if (rc < 0)
292 return rc;
293
294 /* detecting ghost key is not an error */
295 if (pmic8xxx_detect_ghost_keys(kp, new_state))
296 return 0;
297 __pmic8xxx_kp_scan_matrix(kp, new_state, kp->keystate);
298 memcpy(kp->keystate, new_state, sizeof(new_state));
299 break;
300 case 0x3: /* two events - eventcounter is gray-coded */
301 rc = pmic8xxx_kp_read_matrix(kp, new_state, old_state);
302 if (rc < 0)
303 return rc;
304
305 __pmic8xxx_kp_scan_matrix(kp, old_state, kp->keystate);
306 __pmic8xxx_kp_scan_matrix(kp, new_state, old_state);
307 memcpy(kp->keystate, new_state, sizeof(new_state));
308 break;
309 case 0x2:
310 dev_dbg(kp->dev, "Some key events were lost\n");
311 rc = pmic8xxx_kp_read_matrix(kp, new_state, old_state);
312 if (rc < 0)
313 return rc;
314 __pmic8xxx_kp_scan_matrix(kp, old_state, kp->keystate);
315 __pmic8xxx_kp_scan_matrix(kp, new_state, old_state);
316 memcpy(kp->keystate, new_state, sizeof(new_state));
317 break;
318 default:
319 rc = -EINVAL;
320 }
321 return rc;
322}
323
324/*
325 * NOTE: We are reading recent and old data registers blindly
326 * whenever key-stuck interrupt happens, because events counter doesn't
327 * get updated when this interrupt happens due to key stuck doesn't get
328 * considered as key state change.
329 *
330 * We are not using old data register contents after they are being read
331 * because it might report the key which was pressed before the key being stuck
332 * as stuck key because it's pressed status is stored in the old data
333 * register.
334 */
335static irqreturn_t pmic8xxx_kp_stuck_irq(int irq, void *data)
336{
337 u16 new_state[PM8XXX_MAX_ROWS];
338 u16 old_state[PM8XXX_MAX_ROWS];
339 int rc;
340 struct pmic8xxx_kp *kp = data;
341
342 rc = pmic8xxx_kp_read_matrix(kp, new_state, old_state);
343 if (rc < 0) {
344 dev_err(kp->dev, "failed to read keypad matrix\n");
345 return IRQ_HANDLED;
346 }
347
348 __pmic8xxx_kp_scan_matrix(kp, new_state, kp->stuckstate);
349
350 return IRQ_HANDLED;
351}
352
353static irqreturn_t pmic8xxx_kp_irq(int irq, void *data)
354{
355 struct pmic8xxx_kp *kp = data;
356 unsigned int ctrl_val, events;
357 int rc;
358
359 rc = regmap_read(kp->regmap, KEYP_CTRL, &ctrl_val);
360 if (rc < 0) {
361 dev_err(kp->dev, "failed to read keyp_ctrl register\n");
362 return IRQ_HANDLED;
363 }
364
365 events = ctrl_val & KEYP_CTRL_EVNTS_MASK;
366
367 rc = pmic8xxx_kp_scan_matrix(kp, events);
368 if (rc < 0)
369 dev_err(kp->dev, "failed to scan matrix\n");
370
371 return IRQ_HANDLED;
372}
373
374static int pmic8xxx_kpd_init(struct pmic8xxx_kp *kp,
375 struct platform_device *pdev)
376{
377 const struct device_node *of_node = pdev->dev.of_node;
378 unsigned int scan_delay_ms;
379 unsigned int row_hold_ns;
380 unsigned int debounce_ms;
381 int bits, rc, cycles;
382 u8 scan_val = 0, ctrl_val = 0;
383 static const u8 row_bits[] = {
384 0, 1, 2, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7,
385 };
386
387 /* Find column bits */
388 if (kp->num_cols < KEYP_CTRL_SCAN_COLS_MIN)
389 bits = 0;
390 else
391 bits = kp->num_cols - KEYP_CTRL_SCAN_COLS_MIN;
392 ctrl_val = (bits & KEYP_CTRL_SCAN_COLS_BITS) <<
393 KEYP_CTRL_SCAN_COLS_SHIFT;
394
395 /* Find row bits */
396 if (kp->num_rows < KEYP_CTRL_SCAN_ROWS_MIN)
397 bits = 0;
398 else
399 bits = row_bits[kp->num_rows - KEYP_CTRL_SCAN_ROWS_MIN];
400
401 ctrl_val |= (bits << KEYP_CTRL_SCAN_ROWS_SHIFT);
402
403 rc = regmap_write(kp->regmap, KEYP_CTRL, ctrl_val);
404 if (rc < 0) {
405 dev_err(kp->dev, "Error writing KEYP_CTRL reg, rc=%d\n", rc);
406 return rc;
407 }
408
409 if (of_property_read_u32(of_node, "scan-delay", &scan_delay_ms))
410 scan_delay_ms = MIN_SCAN_DELAY;
411
412 if (scan_delay_ms > MAX_SCAN_DELAY || scan_delay_ms < MIN_SCAN_DELAY ||
413 !is_power_of_2(scan_delay_ms)) {
414 dev_err(&pdev->dev, "invalid keypad scan time supplied\n");
415 return -EINVAL;
416 }
417
418 if (of_property_read_u32(of_node, "row-hold", &row_hold_ns))
419 row_hold_ns = MIN_ROW_HOLD_DELAY;
420
421 if (row_hold_ns > MAX_ROW_HOLD_DELAY ||
422 row_hold_ns < MIN_ROW_HOLD_DELAY ||
423 ((row_hold_ns % MIN_ROW_HOLD_DELAY) != 0)) {
424 dev_err(&pdev->dev, "invalid keypad row hold time supplied\n");
425 return -EINVAL;
426 }
427
428 if (of_property_read_u32(of_node, "debounce", &debounce_ms))
429 debounce_ms = MIN_DEBOUNCE_TIME;
430
431 if (((debounce_ms % 5) != 0) ||
432 debounce_ms > MAX_DEBOUNCE_TIME ||
433 debounce_ms < MIN_DEBOUNCE_TIME) {
434 dev_err(&pdev->dev, "invalid debounce time supplied\n");
435 return -EINVAL;
436 }
437
438 bits = (debounce_ms / 5) - 1;
439
440 scan_val |= (bits << KEYP_SCAN_DBOUNCE_SHIFT);
441
442 bits = fls(scan_delay_ms) - 1;
443 scan_val |= (bits << KEYP_SCAN_PAUSE_SHIFT);
444
445 /* Row hold time is a multiple of 32KHz cycles. */
446 cycles = (row_hold_ns * KEYP_CLOCK_FREQ) / NSEC_PER_SEC;
447
448 scan_val |= (cycles << KEYP_SCAN_ROW_HOLD_SHIFT);
449
450 rc = regmap_write(kp->regmap, KEYP_SCAN, scan_val);
451 if (rc)
452 dev_err(kp->dev, "Error writing KEYP_SCAN reg, rc=%d\n", rc);
453
454 return rc;
455
456}
457
458static int pmic8xxx_kp_enable(struct pmic8xxx_kp *kp)
459{
460 int rc;
461
462 kp->ctrl_reg |= KEYP_CTRL_KEYP_EN;
463
464 rc = regmap_write(kp->regmap, KEYP_CTRL, kp->ctrl_reg);
465 if (rc < 0)
466 dev_err(kp->dev, "Error writing KEYP_CTRL reg, rc=%d\n", rc);
467
468 return rc;
469}
470
471static int pmic8xxx_kp_disable(struct pmic8xxx_kp *kp)
472{
473 int rc;
474
475 kp->ctrl_reg &= ~KEYP_CTRL_KEYP_EN;
476
477 rc = regmap_write(kp->regmap, KEYP_CTRL, kp->ctrl_reg);
478 if (rc < 0)
479 return rc;
480
481 return rc;
482}
483
484static int pmic8xxx_kp_open(struct input_dev *dev)
485{
486 struct pmic8xxx_kp *kp = input_get_drvdata(dev);
487
488 return pmic8xxx_kp_enable(kp);
489}
490
491static void pmic8xxx_kp_close(struct input_dev *dev)
492{
493 struct pmic8xxx_kp *kp = input_get_drvdata(dev);
494
495 pmic8xxx_kp_disable(kp);
496}
497
498/*
499 * keypad controller should be initialized in the following sequence
500 * only, otherwise it might get into FSM stuck state.
501 *
502 * - Initialize keypad control parameters, like no. of rows, columns,
503 * timing values etc.,
504 * - configure rows and column gpios pull up/down.
505 * - set irq edge type.
506 * - enable the keypad controller.
507 */
508static int pmic8xxx_kp_probe(struct platform_device *pdev)
509{
510 unsigned int rows, cols;
511 bool repeat;
512 bool wakeup;
513 struct pmic8xxx_kp *kp;
514 int rc;
515 unsigned int ctrl_val;
516
517 rc = matrix_keypad_parse_of_params(&pdev->dev, &rows, &cols);
518 if (rc)
519 return rc;
520
521 if (cols > PM8XXX_MAX_COLS || rows > PM8XXX_MAX_ROWS ||
522 cols < PM8XXX_MIN_COLS) {
523 dev_err(&pdev->dev, "invalid platform data\n");
524 return -EINVAL;
525 }
526
527 repeat = !of_property_read_bool(pdev->dev.of_node,
528 "linux,input-no-autorepeat");
529 wakeup = of_property_read_bool(pdev->dev.of_node,
530 "linux,keypad-wakeup");
531
532 kp = devm_kzalloc(&pdev->dev, sizeof(*kp), GFP_KERNEL);
533 if (!kp)
534 return -ENOMEM;
535
536 kp->regmap = dev_get_regmap(pdev->dev.parent, NULL);
537 if (!kp->regmap)
538 return -ENODEV;
539
540 platform_set_drvdata(pdev, kp);
541
542 kp->num_rows = rows;
543 kp->num_cols = cols;
544 kp->dev = &pdev->dev;
545
546 kp->input = devm_input_allocate_device(&pdev->dev);
547 if (!kp->input) {
548 dev_err(&pdev->dev, "unable to allocate input device\n");
549 return -ENOMEM;
550 }
551
552 kp->key_sense_irq = platform_get_irq(pdev, 0);
553 if (kp->key_sense_irq < 0) {
554 dev_err(&pdev->dev, "unable to get keypad sense irq\n");
555 return kp->key_sense_irq;
556 }
557
558 kp->key_stuck_irq = platform_get_irq(pdev, 1);
559 if (kp->key_stuck_irq < 0) {
560 dev_err(&pdev->dev, "unable to get keypad stuck irq\n");
561 return kp->key_stuck_irq;
562 }
563
564 kp->input->name = "PMIC8XXX keypad";
565 kp->input->phys = "pmic8xxx_keypad/input0";
566
567 kp->input->id.bustype = BUS_I2C;
568 kp->input->id.version = 0x0001;
569 kp->input->id.product = 0x0001;
570 kp->input->id.vendor = 0x0001;
571
572 kp->input->open = pmic8xxx_kp_open;
573 kp->input->close = pmic8xxx_kp_close;
574
575 rc = matrix_keypad_build_keymap(NULL, NULL,
576 PM8XXX_MAX_ROWS, PM8XXX_MAX_COLS,
577 kp->keycodes, kp->input);
578 if (rc) {
579 dev_err(&pdev->dev, "failed to build keymap\n");
580 return rc;
581 }
582
583 if (repeat)
584 __set_bit(EV_REP, kp->input->evbit);
585 input_set_capability(kp->input, EV_MSC, MSC_SCAN);
586
587 input_set_drvdata(kp->input, kp);
588
589 /* initialize keypad state */
590 memset(kp->keystate, 0xff, sizeof(kp->keystate));
591 memset(kp->stuckstate, 0xff, sizeof(kp->stuckstate));
592
593 rc = pmic8xxx_kpd_init(kp, pdev);
594 if (rc < 0) {
595 dev_err(&pdev->dev, "unable to initialize keypad controller\n");
596 return rc;
597 }
598
599 rc = devm_request_any_context_irq(&pdev->dev, kp->key_sense_irq,
600 pmic8xxx_kp_irq, IRQF_TRIGGER_RISING, "pmic-keypad",
601 kp);
602 if (rc < 0) {
603 dev_err(&pdev->dev, "failed to request keypad sense irq\n");
604 return rc;
605 }
606
607 rc = devm_request_any_context_irq(&pdev->dev, kp->key_stuck_irq,
608 pmic8xxx_kp_stuck_irq, IRQF_TRIGGER_RISING,
609 "pmic-keypad-stuck", kp);
610 if (rc < 0) {
611 dev_err(&pdev->dev, "failed to request keypad stuck irq\n");
612 return rc;
613 }
614
615 rc = regmap_read(kp->regmap, KEYP_CTRL, &ctrl_val);
616 if (rc < 0) {
617 dev_err(&pdev->dev, "failed to read KEYP_CTRL register\n");
618 return rc;
619 }
620
621 kp->ctrl_reg = ctrl_val;
622
623 rc = input_register_device(kp->input);
624 if (rc < 0) {
625 dev_err(&pdev->dev, "unable to register keypad input device\n");
626 return rc;
627 }
628
629 device_init_wakeup(&pdev->dev, wakeup);
630
631 return 0;
632}
633
634#ifdef CONFIG_PM_SLEEP
635static int pmic8xxx_kp_suspend(struct device *dev)
636{
637 struct platform_device *pdev = to_platform_device(dev);
638 struct pmic8xxx_kp *kp = platform_get_drvdata(pdev);
639 struct input_dev *input_dev = kp->input;
640
641 if (device_may_wakeup(dev)) {
642 enable_irq_wake(kp->key_sense_irq);
643 } else {
644 mutex_lock(&input_dev->mutex);
645
646 if (input_dev->users)
647 pmic8xxx_kp_disable(kp);
648
649 mutex_unlock(&input_dev->mutex);
650 }
651
652 return 0;
653}
654
655static int pmic8xxx_kp_resume(struct device *dev)
656{
657 struct platform_device *pdev = to_platform_device(dev);
658 struct pmic8xxx_kp *kp = platform_get_drvdata(pdev);
659 struct input_dev *input_dev = kp->input;
660
661 if (device_may_wakeup(dev)) {
662 disable_irq_wake(kp->key_sense_irq);
663 } else {
664 mutex_lock(&input_dev->mutex);
665
666 if (input_dev->users)
667 pmic8xxx_kp_enable(kp);
668
669 mutex_unlock(&input_dev->mutex);
670 }
671
672 return 0;
673}
674#endif
675
676static SIMPLE_DEV_PM_OPS(pm8xxx_kp_pm_ops,
677 pmic8xxx_kp_suspend, pmic8xxx_kp_resume);
678
679static const struct of_device_id pm8xxx_match_table[] = {
680 { .compatible = "qcom,pm8058-keypad" },
681 { .compatible = "qcom,pm8921-keypad" },
682 { }
683};
684MODULE_DEVICE_TABLE(of, pm8xxx_match_table);
685
686static struct platform_driver pmic8xxx_kp_driver = {
687 .probe = pmic8xxx_kp_probe,
688 .driver = {
689 .name = "pm8xxx-keypad",
690 .owner = THIS_MODULE,
691 .pm = &pm8xxx_kp_pm_ops,
692 .of_match_table = pm8xxx_match_table,
693 },
694};
695module_platform_driver(pmic8xxx_kp_driver);
696
697MODULE_LICENSE("GPL v2");
698MODULE_DESCRIPTION("PMIC8XXX keypad driver");
699MODULE_VERSION("1.0");
700MODULE_ALIAS("platform:pmic8xxx_keypad");
701MODULE_AUTHOR("Trilok Soni <tsoni@codeaurora.org>");