Lines Matching defs:kp
116 static u8 pmic8xxx_col_state(struct pmic8xxx_kp *kp, u8 col)
120 return 1 << kp->num_cols;
122 return col & ((1 << kp->num_cols) - 1);
137 static int pmic8xxx_chk_sync_read(struct pmic8xxx_kp *kp)
142 rc = regmap_read(kp->regmap, KEYP_SCAN, &scan_val);
144 dev_err(kp->dev, "Error reading KEYP_SCAN reg, rc=%d\n", rc);
150 rc = regmap_write(kp->regmap, KEYP_SCAN, scan_val);
152 dev_err(kp->dev, "Error writing KEYP_SCAN reg, rc=%d\n", rc);
162 static int pmic8xxx_kp_read_data(struct pmic8xxx_kp *kp, u16 *state,
169 rc = regmap_read(kp->regmap, data_reg, &val);
172 dev_dbg(kp->dev, "%d = %d\n", row, val);
173 state[row] = pmic8xxx_col_state(kp, val);
179 static int pmic8xxx_kp_read_matrix(struct pmic8xxx_kp *kp, u16 *new_state,
185 if (kp->num_rows < PM8XXX_MIN_ROWS)
188 read_rows = kp->num_rows;
190 pmic8xxx_chk_sync_read(kp);
193 rc = pmic8xxx_kp_read_data(kp, old_state, KEYP_OLD_DATA,
196 dev_err(kp->dev,
202 rc = pmic8xxx_kp_read_data(kp, new_state, KEYP_RECENT_DATA,
205 dev_err(kp->dev,
213 rc = regmap_read(kp->regmap, KEYP_SCAN, &scan_val);
215 dev_err(kp->dev, "Error reading KEYP_SCAN reg, rc=%d\n", rc);
220 rc = regmap_write(kp->regmap, KEYP_SCAN, scan_val);
222 dev_err(kp->dev, "Error writing KEYP_SCAN reg, rc=%d\n", rc);
227 static void __pmic8xxx_kp_scan_matrix(struct pmic8xxx_kp *kp, u16 *new_state,
232 for (row = 0; row < kp->num_rows; row++) {
238 for (col = 0; col < kp->num_cols; col++) {
242 dev_dbg(kp->dev, "key [%d:%d] %s\n", row, col,
248 input_event(kp->input, EV_MSC, MSC_SCAN, code);
249 input_report_key(kp->input,
250 kp->keycodes[code],
253 input_sync(kp->input);
258 static bool pmic8xxx_detect_ghost_keys(struct pmic8xxx_kp *kp, u16 *new_state)
264 for (row = 0; row < kp->num_rows; row++) {
266 ((1 << kp->num_cols) - 1);
272 dev_dbg(kp->dev, "detected ghost key on row[%d]"
282 static int pmic8xxx_kp_scan_matrix(struct pmic8xxx_kp *kp, unsigned int events)
290 rc = pmic8xxx_kp_read_matrix(kp, new_state, NULL);
295 if (pmic8xxx_detect_ghost_keys(kp, new_state))
297 __pmic8xxx_kp_scan_matrix(kp, new_state, kp->keystate);
298 memcpy(kp->keystate, new_state, sizeof(new_state));
301 rc = pmic8xxx_kp_read_matrix(kp, new_state, old_state);
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));
310 dev_dbg(kp->dev, "Some key events were lost\n");
311 rc = pmic8xxx_kp_read_matrix(kp, new_state, old_state);
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));
340 struct pmic8xxx_kp *kp = data;
342 rc = pmic8xxx_kp_read_matrix(kp, new_state, old_state);
344 dev_err(kp->dev, "failed to read keypad matrix\n");
348 __pmic8xxx_kp_scan_matrix(kp, new_state, kp->stuckstate);
355 struct pmic8xxx_kp *kp = data;
359 rc = regmap_read(kp->regmap, KEYP_CTRL, &ctrl_val);
361 dev_err(kp->dev, "failed to read keyp_ctrl register\n");
367 rc = pmic8xxx_kp_scan_matrix(kp, events);
369 dev_err(kp->dev, "failed to scan matrix\n");
374 static int pmic8xxx_kpd_init(struct pmic8xxx_kp *kp,
388 if (kp->num_cols < KEYP_CTRL_SCAN_COLS_MIN)
391 bits = kp->num_cols - KEYP_CTRL_SCAN_COLS_MIN;
396 if (kp->num_rows < KEYP_CTRL_SCAN_ROWS_MIN)
399 bits = row_bits[kp->num_rows - KEYP_CTRL_SCAN_ROWS_MIN];
403 rc = regmap_write(kp->regmap, KEYP_CTRL, ctrl_val);
405 dev_err(kp->dev, "Error writing KEYP_CTRL reg, rc=%d\n", rc);
450 rc = regmap_write(kp->regmap, KEYP_SCAN, scan_val);
452 dev_err(kp->dev, "Error writing KEYP_SCAN reg, rc=%d\n", rc);
458 static int pmic8xxx_kp_enable(struct pmic8xxx_kp *kp)
462 kp->ctrl_reg |= KEYP_CTRL_KEYP_EN;
464 rc = regmap_write(kp->regmap, KEYP_CTRL, kp->ctrl_reg);
466 dev_err(kp->dev, "Error writing KEYP_CTRL reg, rc=%d\n", rc);
471 static int pmic8xxx_kp_disable(struct pmic8xxx_kp *kp)
475 kp->ctrl_reg &= ~KEYP_CTRL_KEYP_EN;
477 rc = regmap_write(kp->regmap, KEYP_CTRL, kp->ctrl_reg);
486 struct pmic8xxx_kp *kp = input_get_drvdata(dev);
488 return pmic8xxx_kp_enable(kp);
493 struct pmic8xxx_kp *kp = input_get_drvdata(dev);
495 pmic8xxx_kp_disable(kp);
513 struct pmic8xxx_kp *kp;
532 kp = devm_kzalloc(&pdev->dev, sizeof(*kp), GFP_KERNEL);
533 if (!kp)
536 kp->regmap = dev_get_regmap(pdev->dev.parent, NULL);
537 if (!kp->regmap)
540 platform_set_drvdata(pdev, kp);
542 kp->num_rows = rows;
543 kp->num_cols = cols;
544 kp->dev = &pdev->dev;
546 kp->input = devm_input_allocate_device(&pdev->dev);
547 if (!kp->input) {
552 kp->key_sense_irq = platform_get_irq(pdev, 0);
553 if (kp->key_sense_irq < 0) {
555 return kp->key_sense_irq;
558 kp->key_stuck_irq = platform_get_irq(pdev, 1);
559 if (kp->key_stuck_irq < 0) {
561 return kp->key_stuck_irq;
564 kp->input->name = "PMIC8XXX keypad";
565 kp->input->phys = "pmic8xxx_keypad/input0";
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;
572 kp->input->open = pmic8xxx_kp_open;
573 kp->input->close = pmic8xxx_kp_close;
577 kp->keycodes, kp->input);
584 __set_bit(EV_REP, kp->input->evbit);
585 input_set_capability(kp->input, EV_MSC, MSC_SCAN);
587 input_set_drvdata(kp->input, kp);
590 memset(kp->keystate, 0xff, sizeof(kp->keystate));
591 memset(kp->stuckstate, 0xff, sizeof(kp->stuckstate));
593 rc = pmic8xxx_kpd_init(kp, pdev);
599 rc = devm_request_any_context_irq(&pdev->dev, kp->key_sense_irq,
601 kp);
607 rc = devm_request_any_context_irq(&pdev->dev, kp->key_stuck_irq,
609 "pmic-keypad-stuck", kp);
615 rc = regmap_read(kp->regmap, KEYP_CTRL, &ctrl_val);
621 kp->ctrl_reg = ctrl_val;
623 rc = input_register_device(kp->input);
638 struct pmic8xxx_kp *kp = platform_get_drvdata(pdev);
639 struct input_dev *input_dev = kp->input;
642 enable_irq_wake(kp->key_sense_irq);
647 pmic8xxx_kp_disable(kp);
658 struct pmic8xxx_kp *kp = platform_get_drvdata(pdev);
659 struct input_dev *input_dev = kp->input;
662 disable_irq_wake(kp->key_sense_irq);
667 pmic8xxx_kp_enable(kp);