156 static void tegra_kbc_report_keys(struct tegra_kbc *kbc)  in tegra_kbc_report_keys()  argument
169 			val = readl(kbc->mmio + KBC_KP_ENT0_0 + i);  in tegra_kbc_report_keys()
178 			keycodes[num_down] = kbc->keycode[scancode];  in tegra_kbc_report_keys()
180 			if ((keycodes[num_down] == KEY_FN) && kbc->use_fn_map)  in tegra_kbc_report_keys()
195 	if (kbc->use_ghost_filter && num_down >= 3) {  in tegra_kbc_report_keys()
223 			scancodes[i] += kbc->max_keys;  in tegra_kbc_report_keys()
224 			keycodes[i] = kbc->keycode[scancodes[i]];  in tegra_kbc_report_keys()
232 	tegra_kbc_report_released_keys(kbc->idev,  in tegra_kbc_report_keys()
233 				       kbc->current_keys, kbc->num_pressed_keys,  in tegra_kbc_report_keys()
235 	tegra_kbc_report_pressed_keys(kbc->idev, scancodes, keycodes, num_down);  in tegra_kbc_report_keys()
236 	input_sync(kbc->idev);  in tegra_kbc_report_keys()
238 	memcpy(kbc->current_keys, keycodes, sizeof(kbc->current_keys));  in tegra_kbc_report_keys()
239 	kbc->num_pressed_keys = num_down;  in tegra_kbc_report_keys()
242 static void tegra_kbc_set_fifo_interrupt(struct tegra_kbc *kbc, bool enable)  in tegra_kbc_set_fifo_interrupt()  argument
246 	val = readl(kbc->mmio + KBC_CONTROL_0);  in tegra_kbc_set_fifo_interrupt()
251 	writel(val, kbc->mmio + KBC_CONTROL_0);  in tegra_kbc_set_fifo_interrupt()
256 	struct tegra_kbc *kbc = (struct tegra_kbc *)data;  in tegra_kbc_keypress_timer()  local
261 	spin_lock_irqsave(&kbc->lock, flags);  in tegra_kbc_keypress_timer()
263 	val = (readl(kbc->mmio + KBC_INT_0) >> 4) & 0xf;  in tegra_kbc_keypress_timer()
267 		tegra_kbc_report_keys(kbc);  in tegra_kbc_keypress_timer()
273 		dly = (val == 1) ? kbc->repoll_dly : 1;  in tegra_kbc_keypress_timer()
274 		mod_timer(&kbc->timer, jiffies + msecs_to_jiffies(dly));  in tegra_kbc_keypress_timer()
277 		for (i = 0; i < kbc->num_pressed_keys; i++)  in tegra_kbc_keypress_timer()
278 			input_report_key(kbc->idev, kbc->current_keys[i], 0);  in tegra_kbc_keypress_timer()
279 		input_sync(kbc->idev);  in tegra_kbc_keypress_timer()
281 		kbc->num_pressed_keys = 0;  in tegra_kbc_keypress_timer()
284 		tegra_kbc_set_fifo_interrupt(kbc, true);  in tegra_kbc_keypress_timer()
287 	spin_unlock_irqrestore(&kbc->lock, flags);  in tegra_kbc_keypress_timer()
292 	struct tegra_kbc *kbc = args;  in tegra_kbc_isr()  local
296 	spin_lock_irqsave(&kbc->lock, flags);  in tegra_kbc_isr()
302 	val = readl(kbc->mmio + KBC_INT_0);  in tegra_kbc_isr()
303 	writel(val, kbc->mmio + KBC_INT_0);  in tegra_kbc_isr()
310 		tegra_kbc_set_fifo_interrupt(kbc, false);  in tegra_kbc_isr()
311 		mod_timer(&kbc->timer, jiffies + kbc->cp_dly_jiffies);  in tegra_kbc_isr()
314 		kbc->keypress_caused_wake = true;  in tegra_kbc_isr()
317 	spin_unlock_irqrestore(&kbc->lock, flags);  in tegra_kbc_isr()
322 static void tegra_kbc_setup_wakekeys(struct tegra_kbc *kbc, bool filter)  in tegra_kbc_setup_wakekeys()  argument
328 	rst_val = (filter && !kbc->wakeup) ? ~0 : 0;  in tegra_kbc_setup_wakekeys()
330 	for (i = 0; i < kbc->hw_support->max_rows; i++)  in tegra_kbc_setup_wakekeys()
331 		writel(rst_val, kbc->mmio + KBC_ROW0_MASK_0 + i * 4);  in tegra_kbc_setup_wakekeys()
334 static void tegra_kbc_config_pins(struct tegra_kbc *kbc)  in tegra_kbc_config_pins()  argument
345 		u32 row_cfg = readl(kbc->mmio + r_offs);  in tegra_kbc_config_pins()
346 		u32 col_cfg = readl(kbc->mmio + c_offs);  in tegra_kbc_config_pins()
351 		switch (kbc->pin_cfg[i].type) {  in tegra_kbc_config_pins()
353 			row_cfg |= ((kbc->pin_cfg[i].num << 1) | 1) << r_shft;  in tegra_kbc_config_pins()
357 			col_cfg |= ((kbc->pin_cfg[i].num << 1) | 1) << c_shft;  in tegra_kbc_config_pins()
364 		writel(row_cfg, kbc->mmio + r_offs);  in tegra_kbc_config_pins()
365 		writel(col_cfg, kbc->mmio + c_offs);  in tegra_kbc_config_pins()
369 static int tegra_kbc_start(struct tegra_kbc *kbc)  in tegra_kbc_start()  argument
374 	clk_prepare_enable(kbc->clk);  in tegra_kbc_start()
377 	reset_control_assert(kbc->rst);  in tegra_kbc_start()
379 	reset_control_assert(kbc->rst);  in tegra_kbc_start()
382 	tegra_kbc_config_pins(kbc);  in tegra_kbc_start()
383 	tegra_kbc_setup_wakekeys(kbc, false);  in tegra_kbc_start()
385 	writel(kbc->repeat_cnt, kbc->mmio + KBC_RPT_DLY_0);  in tegra_kbc_start()
388 	debounce_cnt = min(kbc->debounce_cnt, KBC_MAX_DEBOUNCE_CNT);  in tegra_kbc_start()
393 	writel(val, kbc->mmio + KBC_CONTROL_0);  in tegra_kbc_start()
399 	val = readl(kbc->mmio + KBC_INIT_DLY_0);  in tegra_kbc_start()
400 	kbc->cp_dly_jiffies = usecs_to_jiffies((val & 0xfffff) * 32);  in tegra_kbc_start()
402 	kbc->num_pressed_keys = 0;  in tegra_kbc_start()
409 		val = readl(kbc->mmio + KBC_INT_0);  in tegra_kbc_start()
414 		val = readl(kbc->mmio + KBC_KP_ENT0_0);  in tegra_kbc_start()
415 		val = readl(kbc->mmio + KBC_KP_ENT1_0);  in tegra_kbc_start()
417 	writel(0x7, kbc->mmio + KBC_INT_0);  in tegra_kbc_start()
419 	enable_irq(kbc->irq);  in tegra_kbc_start()
424 static void tegra_kbc_stop(struct tegra_kbc *kbc)  in tegra_kbc_stop()  argument
429 	spin_lock_irqsave(&kbc->lock, flags);  in tegra_kbc_stop()
430 	val = readl(kbc->mmio + KBC_CONTROL_0);  in tegra_kbc_stop()
432 	writel(val, kbc->mmio + KBC_CONTROL_0);  in tegra_kbc_stop()
433 	spin_unlock_irqrestore(&kbc->lock, flags);  in tegra_kbc_stop()
435 	disable_irq(kbc->irq);  in tegra_kbc_stop()
436 	del_timer_sync(&kbc->timer);  in tegra_kbc_stop()
438 	clk_disable_unprepare(kbc->clk);  in tegra_kbc_stop()
443 	struct tegra_kbc *kbc = input_get_drvdata(dev);  in tegra_kbc_open()  local
445 	return tegra_kbc_start(kbc);  in tegra_kbc_open()
450 	struct tegra_kbc *kbc = input_get_drvdata(dev);  in tegra_kbc_close()  local
452 	return tegra_kbc_stop(kbc);  in tegra_kbc_close()
455 static bool tegra_kbc_check_pin_cfg(const struct tegra_kbc *kbc,  in tegra_kbc_check_pin_cfg()  argument
463 		const struct tegra_kbc_pin_cfg *pin_cfg = &kbc->pin_cfg[i];  in tegra_kbc_check_pin_cfg()
467 			if (pin_cfg->num >= kbc->hw_support->max_rows) {  in tegra_kbc_check_pin_cfg()
468 				dev_err(kbc->dev,  in tegra_kbc_check_pin_cfg()
477 			if (pin_cfg->num >= kbc->hw_support->max_columns) {  in tegra_kbc_check_pin_cfg()
478 				dev_err(kbc->dev,  in tegra_kbc_check_pin_cfg()
489 			dev_err(kbc->dev,  in tegra_kbc_check_pin_cfg()
499 static int tegra_kbc_parse_dt(struct tegra_kbc *kbc)  in tegra_kbc_parse_dt()  argument
501 	struct device_node *np = kbc->dev->of_node;  in tegra_kbc_parse_dt()
512 		kbc->debounce_cnt = prop;  in tegra_kbc_parse_dt()
515 		kbc->repeat_cnt = prop;  in tegra_kbc_parse_dt()
518 		kbc->use_ghost_filter = true;  in tegra_kbc_parse_dt()
522 		kbc->wakeup = true;  in tegra_kbc_parse_dt()
525 		dev_err(kbc->dev, "property nvidia,kbc-row-pins not found\n");  in tegra_kbc_parse_dt()
531 		dev_err(kbc->dev, "property nvidia,kbc-col-pins not found\n");  in tegra_kbc_parse_dt()
536 	if (num_rows > kbc->hw_support->max_rows) {  in tegra_kbc_parse_dt()
537 		dev_err(kbc->dev,  in tegra_kbc_parse_dt()
542 	if (num_cols > kbc->hw_support->max_columns) {  in tegra_kbc_parse_dt()
543 		dev_err(kbc->dev,  in tegra_kbc_parse_dt()
549 		dev_err(kbc->dev, "property linux,keymap not found\n");  in tegra_kbc_parse_dt()
554 		dev_err(kbc->dev,  in tegra_kbc_parse_dt()
560 	for (i = 0; i < kbc->num_rows_and_columns; i++)  in tegra_kbc_parse_dt()
561 		kbc->pin_cfg[i].type = PIN_CFG_IGNORE;  in tegra_kbc_parse_dt()
566 		dev_err(kbc->dev, "Rows configurations are not proper\n");  in tegra_kbc_parse_dt()
573 		dev_err(kbc->dev, "Cols configurations are not proper\n");  in tegra_kbc_parse_dt()
578 		kbc->pin_cfg[rows_cfg[i]].type = PIN_CFG_ROW;  in tegra_kbc_parse_dt()
579 		kbc->pin_cfg[rows_cfg[i]].num = i;  in tegra_kbc_parse_dt()
583 		kbc->pin_cfg[cols_cfg[i]].type = PIN_CFG_COL;  in tegra_kbc_parse_dt()
584 		kbc->pin_cfg[cols_cfg[i]].num = i;  in tegra_kbc_parse_dt()
610 	struct tegra_kbc *kbc;  in tegra_kbc_probe()  local
621 	kbc = devm_kzalloc(&pdev->dev, sizeof(*kbc), GFP_KERNEL);  in tegra_kbc_probe()
622 	if (!kbc) {  in tegra_kbc_probe()
627 	kbc->dev = &pdev->dev;  in tegra_kbc_probe()
628 	kbc->hw_support = match->data;  in tegra_kbc_probe()
629 	kbc->max_keys = kbc->hw_support->max_rows *  in tegra_kbc_probe()
630 				kbc->hw_support->max_columns;  in tegra_kbc_probe()
631 	kbc->num_rows_and_columns = kbc->hw_support->max_rows +  in tegra_kbc_probe()
632 					kbc->hw_support->max_columns;  in tegra_kbc_probe()
633 	keymap_rows = kbc->max_keys;  in tegra_kbc_probe()
634 	spin_lock_init(&kbc->lock);  in tegra_kbc_probe()
636 	err = tegra_kbc_parse_dt(kbc);  in tegra_kbc_probe()
640 	if (!tegra_kbc_check_pin_cfg(kbc, &num_rows))  in tegra_kbc_probe()
643 	kbc->irq = platform_get_irq(pdev, 0);  in tegra_kbc_probe()
644 	if (kbc->irq < 0) {  in tegra_kbc_probe()
649 	kbc->idev = devm_input_allocate_device(&pdev->dev);  in tegra_kbc_probe()
650 	if (!kbc->idev) {  in tegra_kbc_probe()
655 	setup_timer(&kbc->timer, tegra_kbc_keypress_timer, (unsigned long)kbc);  in tegra_kbc_probe()
658 	kbc->mmio = devm_ioremap_resource(&pdev->dev, res);  in tegra_kbc_probe()
659 	if (IS_ERR(kbc->mmio))  in tegra_kbc_probe()
660 		return PTR_ERR(kbc->mmio);  in tegra_kbc_probe()
662 	kbc->clk = devm_clk_get(&pdev->dev, NULL);  in tegra_kbc_probe()
663 	if (IS_ERR(kbc->clk)) {  in tegra_kbc_probe()
665 		return PTR_ERR(kbc->clk);  in tegra_kbc_probe()
668 	kbc->rst = devm_reset_control_get(&pdev->dev, "kbc");  in tegra_kbc_probe()
669 	if (IS_ERR(kbc->rst)) {  in tegra_kbc_probe()
671 		return PTR_ERR(kbc->rst);  in tegra_kbc_probe()
680 	debounce_cnt = min(kbc->debounce_cnt, KBC_MAX_DEBOUNCE_CNT);  in tegra_kbc_probe()
682 	kbc->repoll_dly = KBC_ROW_SCAN_DLY + scan_time_rows + kbc->repeat_cnt;  in tegra_kbc_probe()
683 	kbc->repoll_dly = DIV_ROUND_UP(kbc->repoll_dly, KBC_CYCLE_MS);  in tegra_kbc_probe()
685 	kbc->idev->name = pdev->name;  in tegra_kbc_probe()
686 	kbc->idev->id.bustype = BUS_HOST;  in tegra_kbc_probe()
687 	kbc->idev->dev.parent = &pdev->dev;  in tegra_kbc_probe()
688 	kbc->idev->open = tegra_kbc_open;  in tegra_kbc_probe()
689 	kbc->idev->close = tegra_kbc_close;  in tegra_kbc_probe()
691 	if (kbc->keymap_data && kbc->use_fn_map)  in tegra_kbc_probe()
694 	err = matrix_keypad_build_keymap(kbc->keymap_data, NULL,  in tegra_kbc_probe()
696 					 kbc->hw_support->max_columns,  in tegra_kbc_probe()
697 					 kbc->keycode, kbc->idev);  in tegra_kbc_probe()
703 	__set_bit(EV_REP, kbc->idev->evbit);  in tegra_kbc_probe()
704 	input_set_capability(kbc->idev, EV_MSC, MSC_SCAN);  in tegra_kbc_probe()
706 	input_set_drvdata(kbc->idev, kbc);  in tegra_kbc_probe()
708 	err = devm_request_irq(&pdev->dev, kbc->irq, tegra_kbc_isr,  in tegra_kbc_probe()
709 			       IRQF_TRIGGER_HIGH, pdev->name, kbc);  in tegra_kbc_probe()
715 	disable_irq(kbc->irq);  in tegra_kbc_probe()
717 	err = input_register_device(kbc->idev);  in tegra_kbc_probe()
723 	platform_set_drvdata(pdev, kbc);  in tegra_kbc_probe()
724 	device_init_wakeup(&pdev->dev, kbc->wakeup);  in tegra_kbc_probe()
730 static void tegra_kbc_set_keypress_interrupt(struct tegra_kbc *kbc, bool enable)  in tegra_kbc_set_keypress_interrupt()  argument
734 	val = readl(kbc->mmio + KBC_CONTROL_0);  in tegra_kbc_set_keypress_interrupt()
739 	writel(val, kbc->mmio + KBC_CONTROL_0);  in tegra_kbc_set_keypress_interrupt()
745 	struct tegra_kbc *kbc = platform_get_drvdata(pdev);  in tegra_kbc_suspend()  local
747 	mutex_lock(&kbc->idev->mutex);  in tegra_kbc_suspend()
749 		disable_irq(kbc->irq);  in tegra_kbc_suspend()
750 		del_timer_sync(&kbc->timer);  in tegra_kbc_suspend()
751 		tegra_kbc_set_fifo_interrupt(kbc, false);  in tegra_kbc_suspend()
754 		writel(0x7, kbc->mmio + KBC_INT_0);  in tegra_kbc_suspend()
759 		kbc->cp_to_wkup_dly = readl(kbc->mmio + KBC_TO_CNT_0);  in tegra_kbc_suspend()
760 		writel(0, kbc->mmio + KBC_TO_CNT_0);  in tegra_kbc_suspend()
762 		tegra_kbc_setup_wakekeys(kbc, true);  in tegra_kbc_suspend()
765 		kbc->keypress_caused_wake = false;  in tegra_kbc_suspend()
767 		tegra_kbc_set_keypress_interrupt(kbc, true);  in tegra_kbc_suspend()
768 		enable_irq(kbc->irq);  in tegra_kbc_suspend()
769 		enable_irq_wake(kbc->irq);  in tegra_kbc_suspend()
771 		if (kbc->idev->users)  in tegra_kbc_suspend()
772 			tegra_kbc_stop(kbc);  in tegra_kbc_suspend()
774 	mutex_unlock(&kbc->idev->mutex);  in tegra_kbc_suspend()
782 	struct tegra_kbc *kbc = platform_get_drvdata(pdev);  in tegra_kbc_resume()  local
785 	mutex_lock(&kbc->idev->mutex);  in tegra_kbc_resume()
787 		disable_irq_wake(kbc->irq);  in tegra_kbc_resume()
788 		tegra_kbc_setup_wakekeys(kbc, false);  in tegra_kbc_resume()
790 		tegra_kbc_set_keypress_interrupt(kbc, false);  in tegra_kbc_resume()
793 		writel(kbc->cp_to_wkup_dly, kbc->mmio + KBC_TO_CNT_0);  in tegra_kbc_resume()
795 		tegra_kbc_set_fifo_interrupt(kbc, true);  in tegra_kbc_resume()
797 		if (kbc->keypress_caused_wake && kbc->wakeup_key) {  in tegra_kbc_resume()
805 			input_report_key(kbc->idev, kbc->wakeup_key, 1);  in tegra_kbc_resume()
806 			input_sync(kbc->idev);  in tegra_kbc_resume()
807 			input_report_key(kbc->idev, kbc->wakeup_key, 0);  in tegra_kbc_resume()
808 			input_sync(kbc->idev);  in tegra_kbc_resume()
811 		if (kbc->idev->users)  in tegra_kbc_resume()
812 			err = tegra_kbc_start(kbc);  in tegra_kbc_resume()
814 	mutex_unlock(&kbc->idev->mutex);  in tegra_kbc_resume()