Version:  2.0.40 2.2.26 2.4.37 3.1 3.2 3.3 3.4 3.5 3.6 3.7 3.8 3.9 3.10 3.11 3.12 3.13 3.14 3.15 3.16 3.17

Linux/drivers/input/keyboard/pmic8xxx-keypad.c

  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  * '' 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  */
 99 struct 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 
116 static 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 '' to ReadState bit of KEYP_SCAN register so that hw can
135  *    synchronously exit read mode.
136  */
137 static 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 
162 static 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 
179 static 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 
227 static 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 
258 static 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 
282 static 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  */
335 static 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 
353 static 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 
374 static 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 
458 static 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 
471 static 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 
484 static 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 
491 static 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  */
508 static 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
635 static 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 
655 static 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 
676 static SIMPLE_DEV_PM_OPS(pm8xxx_kp_pm_ops,
677                          pmic8xxx_kp_suspend, pmic8xxx_kp_resume);
678 
679 static const struct of_device_id pm8xxx_match_table[] = {
680         { .compatible = "qcom,pm8058-keypad" },
681         { .compatible = "qcom,pm8921-keypad" },
682         { }
683 };
684 MODULE_DEVICE_TABLE(of, pm8xxx_match_table);
685 
686 static 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 };
695 module_platform_driver(pmic8xxx_kp_driver);
696 
697 MODULE_LICENSE("GPL v2");
698 MODULE_DESCRIPTION("PMIC8XXX keypad driver");
699 MODULE_VERSION("1.0");
700 MODULE_ALIAS("platform:pmic8xxx_keypad");
701 MODULE_AUTHOR("Trilok Soni <tsoni@codeaurora.org>");
702 

This page was automatically generated by LXR 0.3.1 (source).  •  Linux is a registered trademark of Linus Torvalds  •  Contact us