Lines Matching refs:kp
116 static u8 pmic8xxx_col_state(struct pmic8xxx_kp *kp, u8 col) in pmic8xxx_col_state() argument
120 return 1 << kp->num_cols; in pmic8xxx_col_state()
122 return col & ((1 << kp->num_cols) - 1); in pmic8xxx_col_state()
137 static int pmic8xxx_chk_sync_read(struct pmic8xxx_kp *kp) in pmic8xxx_chk_sync_read() argument
142 rc = regmap_read(kp->regmap, KEYP_SCAN, &scan_val); in pmic8xxx_chk_sync_read()
144 dev_err(kp->dev, "Error reading KEYP_SCAN reg, rc=%d\n", rc); in pmic8xxx_chk_sync_read()
150 rc = regmap_write(kp->regmap, KEYP_SCAN, scan_val); in pmic8xxx_chk_sync_read()
152 dev_err(kp->dev, "Error writing KEYP_SCAN reg, rc=%d\n", rc); in pmic8xxx_chk_sync_read()
162 static int pmic8xxx_kp_read_data(struct pmic8xxx_kp *kp, u16 *state, in pmic8xxx_kp_read_data() argument
169 rc = regmap_read(kp->regmap, data_reg, &val); in pmic8xxx_kp_read_data()
172 dev_dbg(kp->dev, "%d = %d\n", row, val); in pmic8xxx_kp_read_data()
173 state[row] = pmic8xxx_col_state(kp, val); in pmic8xxx_kp_read_data()
179 static int pmic8xxx_kp_read_matrix(struct pmic8xxx_kp *kp, u16 *new_state, in pmic8xxx_kp_read_matrix() argument
185 if (kp->num_rows < PM8XXX_MIN_ROWS) in pmic8xxx_kp_read_matrix()
188 read_rows = kp->num_rows; in pmic8xxx_kp_read_matrix()
190 pmic8xxx_chk_sync_read(kp); in pmic8xxx_kp_read_matrix()
193 rc = pmic8xxx_kp_read_data(kp, old_state, KEYP_OLD_DATA, in pmic8xxx_kp_read_matrix()
196 dev_err(kp->dev, in pmic8xxx_kp_read_matrix()
202 rc = pmic8xxx_kp_read_data(kp, new_state, KEYP_RECENT_DATA, in pmic8xxx_kp_read_matrix()
205 dev_err(kp->dev, in pmic8xxx_kp_read_matrix()
213 rc = regmap_read(kp->regmap, KEYP_SCAN, &scan_val); in pmic8xxx_kp_read_matrix()
215 dev_err(kp->dev, "Error reading KEYP_SCAN reg, rc=%d\n", rc); in pmic8xxx_kp_read_matrix()
220 rc = regmap_write(kp->regmap, KEYP_SCAN, scan_val); in pmic8xxx_kp_read_matrix()
222 dev_err(kp->dev, "Error writing KEYP_SCAN reg, rc=%d\n", rc); in pmic8xxx_kp_read_matrix()
227 static void __pmic8xxx_kp_scan_matrix(struct pmic8xxx_kp *kp, u16 *new_state, in __pmic8xxx_kp_scan_matrix() argument
232 for (row = 0; row < kp->num_rows; row++) { in __pmic8xxx_kp_scan_matrix()
238 for (col = 0; col < kp->num_cols; col++) { in __pmic8xxx_kp_scan_matrix()
242 dev_dbg(kp->dev, "key [%d:%d] %s\n", row, col, in __pmic8xxx_kp_scan_matrix()
248 input_event(kp->input, EV_MSC, MSC_SCAN, code); in __pmic8xxx_kp_scan_matrix()
249 input_report_key(kp->input, in __pmic8xxx_kp_scan_matrix()
250 kp->keycodes[code], in __pmic8xxx_kp_scan_matrix()
253 input_sync(kp->input); in __pmic8xxx_kp_scan_matrix()
258 static bool pmic8xxx_detect_ghost_keys(struct pmic8xxx_kp *kp, u16 *new_state) in pmic8xxx_detect_ghost_keys() argument
264 for (row = 0; row < kp->num_rows; row++) { in pmic8xxx_detect_ghost_keys()
266 ((1 << kp->num_cols) - 1); in pmic8xxx_detect_ghost_keys()
272 dev_dbg(kp->dev, "detected ghost key on row[%d]" in pmic8xxx_detect_ghost_keys()
282 static int pmic8xxx_kp_scan_matrix(struct pmic8xxx_kp *kp, unsigned int events) in pmic8xxx_kp_scan_matrix() argument
290 rc = pmic8xxx_kp_read_matrix(kp, new_state, NULL); in pmic8xxx_kp_scan_matrix()
295 if (pmic8xxx_detect_ghost_keys(kp, new_state)) in pmic8xxx_kp_scan_matrix()
297 __pmic8xxx_kp_scan_matrix(kp, new_state, kp->keystate); in pmic8xxx_kp_scan_matrix()
298 memcpy(kp->keystate, new_state, sizeof(new_state)); in pmic8xxx_kp_scan_matrix()
301 rc = pmic8xxx_kp_read_matrix(kp, new_state, old_state); in pmic8xxx_kp_scan_matrix()
305 __pmic8xxx_kp_scan_matrix(kp, old_state, kp->keystate); in pmic8xxx_kp_scan_matrix()
306 __pmic8xxx_kp_scan_matrix(kp, new_state, old_state); in pmic8xxx_kp_scan_matrix()
307 memcpy(kp->keystate, new_state, sizeof(new_state)); in pmic8xxx_kp_scan_matrix()
310 dev_dbg(kp->dev, "Some key events were lost\n"); in pmic8xxx_kp_scan_matrix()
311 rc = pmic8xxx_kp_read_matrix(kp, new_state, old_state); in pmic8xxx_kp_scan_matrix()
314 __pmic8xxx_kp_scan_matrix(kp, old_state, kp->keystate); in pmic8xxx_kp_scan_matrix()
315 __pmic8xxx_kp_scan_matrix(kp, new_state, old_state); in pmic8xxx_kp_scan_matrix()
316 memcpy(kp->keystate, new_state, sizeof(new_state)); in pmic8xxx_kp_scan_matrix()
340 struct pmic8xxx_kp *kp = data; in pmic8xxx_kp_stuck_irq() local
342 rc = pmic8xxx_kp_read_matrix(kp, new_state, old_state); in pmic8xxx_kp_stuck_irq()
344 dev_err(kp->dev, "failed to read keypad matrix\n"); in pmic8xxx_kp_stuck_irq()
348 __pmic8xxx_kp_scan_matrix(kp, new_state, kp->stuckstate); in pmic8xxx_kp_stuck_irq()
355 struct pmic8xxx_kp *kp = data; in pmic8xxx_kp_irq() local
359 rc = regmap_read(kp->regmap, KEYP_CTRL, &ctrl_val); in pmic8xxx_kp_irq()
361 dev_err(kp->dev, "failed to read keyp_ctrl register\n"); in pmic8xxx_kp_irq()
367 rc = pmic8xxx_kp_scan_matrix(kp, events); in pmic8xxx_kp_irq()
369 dev_err(kp->dev, "failed to scan matrix\n"); in pmic8xxx_kp_irq()
374 static int pmic8xxx_kpd_init(struct pmic8xxx_kp *kp, in pmic8xxx_kpd_init() argument
388 if (kp->num_cols < KEYP_CTRL_SCAN_COLS_MIN) in pmic8xxx_kpd_init()
391 bits = kp->num_cols - KEYP_CTRL_SCAN_COLS_MIN; in pmic8xxx_kpd_init()
396 if (kp->num_rows < KEYP_CTRL_SCAN_ROWS_MIN) in pmic8xxx_kpd_init()
399 bits = row_bits[kp->num_rows - KEYP_CTRL_SCAN_ROWS_MIN]; in pmic8xxx_kpd_init()
403 rc = regmap_write(kp->regmap, KEYP_CTRL, ctrl_val); in pmic8xxx_kpd_init()
405 dev_err(kp->dev, "Error writing KEYP_CTRL reg, rc=%d\n", rc); in pmic8xxx_kpd_init()
450 rc = regmap_write(kp->regmap, KEYP_SCAN, scan_val); in pmic8xxx_kpd_init()
452 dev_err(kp->dev, "Error writing KEYP_SCAN reg, rc=%d\n", rc); in pmic8xxx_kpd_init()
458 static int pmic8xxx_kp_enable(struct pmic8xxx_kp *kp) in pmic8xxx_kp_enable() argument
462 kp->ctrl_reg |= KEYP_CTRL_KEYP_EN; in pmic8xxx_kp_enable()
464 rc = regmap_write(kp->regmap, KEYP_CTRL, kp->ctrl_reg); in pmic8xxx_kp_enable()
466 dev_err(kp->dev, "Error writing KEYP_CTRL reg, rc=%d\n", rc); in pmic8xxx_kp_enable()
471 static int pmic8xxx_kp_disable(struct pmic8xxx_kp *kp) in pmic8xxx_kp_disable() argument
475 kp->ctrl_reg &= ~KEYP_CTRL_KEYP_EN; in pmic8xxx_kp_disable()
477 rc = regmap_write(kp->regmap, KEYP_CTRL, kp->ctrl_reg); in pmic8xxx_kp_disable()
486 struct pmic8xxx_kp *kp = input_get_drvdata(dev); in pmic8xxx_kp_open() local
488 return pmic8xxx_kp_enable(kp); in pmic8xxx_kp_open()
493 struct pmic8xxx_kp *kp = input_get_drvdata(dev); in pmic8xxx_kp_close() local
495 pmic8xxx_kp_disable(kp); in pmic8xxx_kp_close()
514 struct pmic8xxx_kp *kp; in pmic8xxx_kp_probe() local
534 kp = devm_kzalloc(&pdev->dev, sizeof(*kp), GFP_KERNEL); in pmic8xxx_kp_probe()
535 if (!kp) in pmic8xxx_kp_probe()
538 kp->regmap = dev_get_regmap(pdev->dev.parent, NULL); in pmic8xxx_kp_probe()
539 if (!kp->regmap) in pmic8xxx_kp_probe()
542 platform_set_drvdata(pdev, kp); in pmic8xxx_kp_probe()
544 kp->num_rows = rows; in pmic8xxx_kp_probe()
545 kp->num_cols = cols; in pmic8xxx_kp_probe()
546 kp->dev = &pdev->dev; in pmic8xxx_kp_probe()
548 kp->input = devm_input_allocate_device(&pdev->dev); in pmic8xxx_kp_probe()
549 if (!kp->input) { in pmic8xxx_kp_probe()
554 kp->key_sense_irq = platform_get_irq(pdev, 0); in pmic8xxx_kp_probe()
555 if (kp->key_sense_irq < 0) { in pmic8xxx_kp_probe()
557 return kp->key_sense_irq; in pmic8xxx_kp_probe()
560 kp->key_stuck_irq = platform_get_irq(pdev, 1); in pmic8xxx_kp_probe()
561 if (kp->key_stuck_irq < 0) { in pmic8xxx_kp_probe()
563 return kp->key_stuck_irq; in pmic8xxx_kp_probe()
566 kp->input->name = "PMIC8XXX keypad"; in pmic8xxx_kp_probe()
567 kp->input->phys = "pmic8xxx_keypad/input0"; in pmic8xxx_kp_probe()
569 kp->input->id.bustype = BUS_I2C; in pmic8xxx_kp_probe()
570 kp->input->id.version = 0x0001; in pmic8xxx_kp_probe()
571 kp->input->id.product = 0x0001; in pmic8xxx_kp_probe()
572 kp->input->id.vendor = 0x0001; in pmic8xxx_kp_probe()
574 kp->input->open = pmic8xxx_kp_open; in pmic8xxx_kp_probe()
575 kp->input->close = pmic8xxx_kp_close; in pmic8xxx_kp_probe()
579 kp->keycodes, kp->input); in pmic8xxx_kp_probe()
586 __set_bit(EV_REP, kp->input->evbit); in pmic8xxx_kp_probe()
587 input_set_capability(kp->input, EV_MSC, MSC_SCAN); in pmic8xxx_kp_probe()
589 input_set_drvdata(kp->input, kp); in pmic8xxx_kp_probe()
592 memset(kp->keystate, 0xff, sizeof(kp->keystate)); in pmic8xxx_kp_probe()
593 memset(kp->stuckstate, 0xff, sizeof(kp->stuckstate)); in pmic8xxx_kp_probe()
595 rc = pmic8xxx_kpd_init(kp, pdev); in pmic8xxx_kp_probe()
601 rc = devm_request_any_context_irq(&pdev->dev, kp->key_sense_irq, in pmic8xxx_kp_probe()
603 kp); in pmic8xxx_kp_probe()
609 rc = devm_request_any_context_irq(&pdev->dev, kp->key_stuck_irq, in pmic8xxx_kp_probe()
611 "pmic-keypad-stuck", kp); in pmic8xxx_kp_probe()
617 rc = regmap_read(kp->regmap, KEYP_CTRL, &ctrl_val); in pmic8xxx_kp_probe()
623 kp->ctrl_reg = ctrl_val; in pmic8xxx_kp_probe()
625 rc = input_register_device(kp->input); in pmic8xxx_kp_probe()
640 struct pmic8xxx_kp *kp = platform_get_drvdata(pdev); in pmic8xxx_kp_suspend() local
641 struct input_dev *input_dev = kp->input; in pmic8xxx_kp_suspend()
644 enable_irq_wake(kp->key_sense_irq); in pmic8xxx_kp_suspend()
649 pmic8xxx_kp_disable(kp); in pmic8xxx_kp_suspend()
660 struct pmic8xxx_kp *kp = platform_get_drvdata(pdev); in pmic8xxx_kp_resume() local
661 struct input_dev *input_dev = kp->input; in pmic8xxx_kp_resume()
664 disable_irq_wake(kp->key_sense_irq); in pmic8xxx_kp_resume()
669 pmic8xxx_kp_enable(kp); in pmic8xxx_kp_resume()