pmic8xxx-keypad.c 17 KB

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