90 #define keypad_readl(off)	__raw_readl(keypad->mmio_base + (off))
91 #define keypad_writel(off, v)	__raw_writel((v), keypad->mmio_base + (off))
118 static int pxa27x_keypad_matrix_key_parse_dt(struct pxa27x_keypad *keypad,  in pxa27x_keypad_matrix_key_parse_dt()  argument
121 	struct input_dev *input_dev = keypad->input_dev;  in pxa27x_keypad_matrix_key_parse_dt()
141 					   keypad->keycodes, input_dev);  in pxa27x_keypad_matrix_key_parse_dt()
148 static int pxa27x_keypad_direct_key_parse_dt(struct pxa27x_keypad *keypad,  in pxa27x_keypad_direct_key_parse_dt()  argument
151 	struct input_dev *input_dev = keypad->input_dev;  in pxa27x_keypad_direct_key_parse_dt()
201 		keypad->keycodes[MAX_MATRIX_KEY_NUM + i] = code;  in pxa27x_keypad_direct_key_parse_dt()
208 static int pxa27x_keypad_rotary_parse_dt(struct pxa27x_keypad *keypad,  in pxa27x_keypad_rotary_parse_dt()  argument
217 	struct input_dev *input_dev = keypad->input_dev;  in pxa27x_keypad_rotary_parse_dt()
257 			keypad->keycodes[n] = keycode;  in pxa27x_keypad_rotary_parse_dt()
261 			keypad->keycodes[n + 1] = keycode;  in pxa27x_keypad_rotary_parse_dt()
275 	keypad->rotary_rel_code[0] = pdata->rotary0_rel_code;  in pxa27x_keypad_rotary_parse_dt()
276 	keypad->rotary_rel_code[1] = pdata->rotary1_rel_code;  in pxa27x_keypad_rotary_parse_dt()
281 static int pxa27x_keypad_build_keycode_from_dt(struct pxa27x_keypad *keypad)  in pxa27x_keypad_build_keycode_from_dt()  argument
283 	struct input_dev *input_dev = keypad->input_dev;  in pxa27x_keypad_build_keycode_from_dt()
295 	error = pxa27x_keypad_matrix_key_parse_dt(keypad, pdata);  in pxa27x_keypad_build_keycode_from_dt()
301 	error = pxa27x_keypad_direct_key_parse_dt(keypad, pdata);  in pxa27x_keypad_build_keycode_from_dt()
307 	error = pxa27x_keypad_rotary_parse_dt(keypad, pdata);  in pxa27x_keypad_build_keycode_from_dt()
324 	input_dev->keycodemax = ARRAY_SIZE(keypad->keycodes);  in pxa27x_keypad_build_keycode_from_dt()
326 	keypad->pdata = pdata;  in pxa27x_keypad_build_keycode_from_dt()
332 static int pxa27x_keypad_build_keycode_from_dt(struct pxa27x_keypad *keypad)  in pxa27x_keypad_build_keycode_from_dt()  argument
334 	dev_info(keypad->input_dev->dev.parent, "missing platform data\n");  in pxa27x_keypad_build_keycode_from_dt()
341 static int pxa27x_keypad_build_keycode(struct pxa27x_keypad *keypad)  in pxa27x_keypad_build_keycode()  argument
343 	const struct pxa27x_keypad_platform_data *pdata = keypad->pdata;  in pxa27x_keypad_build_keycode()
344 	struct input_dev *input_dev = keypad->input_dev;  in pxa27x_keypad_build_keycode()
352 					   keypad->keycodes, input_dev);  in pxa27x_keypad_build_keycode()
360 	input_dev->keycodemax = ARRAY_SIZE(keypad->keycodes);  in pxa27x_keypad_build_keycode()
365 		keypad->keycodes[MAX_MATRIX_KEY_NUM + i] = keycode;  in pxa27x_keypad_build_keycode()
372 			keypad->keycodes[MAX_MATRIX_KEY_NUM + 0] = keycode;  in pxa27x_keypad_build_keycode()
376 			keypad->keycodes[MAX_MATRIX_KEY_NUM + 1] = keycode;  in pxa27x_keypad_build_keycode()
379 			keypad->rotary_rel_code[0] = -1;  in pxa27x_keypad_build_keycode()
381 			keypad->rotary_rel_code[0] = pdata->rotary0_rel_code;  in pxa27x_keypad_build_keycode()
389 			keypad->keycodes[MAX_MATRIX_KEY_NUM + 2] = keycode;  in pxa27x_keypad_build_keycode()
393 			keypad->keycodes[MAX_MATRIX_KEY_NUM + 3] = keycode;  in pxa27x_keypad_build_keycode()
396 			keypad->rotary_rel_code[1] = -1;  in pxa27x_keypad_build_keycode()
398 			keypad->rotary_rel_code[1] = pdata->rotary1_rel_code;  in pxa27x_keypad_build_keycode()
408 static void pxa27x_keypad_scan_matrix(struct pxa27x_keypad *keypad)  in pxa27x_keypad_scan_matrix()  argument
410 	const struct pxa27x_keypad_platform_data *pdata = keypad->pdata;  in pxa27x_keypad_scan_matrix()
411 	struct input_dev *input_dev = keypad->input_dev;  in pxa27x_keypad_scan_matrix()
456 		bits_changed = keypad->matrix_key_state[col] ^ new_state[col];  in pxa27x_keypad_scan_matrix()
464 			code = MATRIX_SCAN_CODE(row, col, keypad->row_shift);  in pxa27x_keypad_scan_matrix()
467 			input_report_key(input_dev, keypad->keycodes[code],  in pxa27x_keypad_scan_matrix()
472 	memcpy(keypad->matrix_key_state, new_state, sizeof(new_state));  in pxa27x_keypad_scan_matrix()
487 static void report_rotary_event(struct pxa27x_keypad *keypad, int r, int delta)  in report_rotary_event()  argument
489 	struct input_dev *dev = keypad->input_dev;  in report_rotary_event()
494 	if (keypad->rotary_rel_code[r] == -1) {  in report_rotary_event()
496 		unsigned char keycode = keypad->keycodes[code];  in report_rotary_event()
506 		input_report_rel(dev, keypad->rotary_rel_code[r], delta);  in report_rotary_event()
511 static void pxa27x_keypad_scan_rotary(struct pxa27x_keypad *keypad)  in pxa27x_keypad_scan_rotary()  argument
513 	const struct pxa27x_keypad_platform_data *pdata = keypad->pdata;  in pxa27x_keypad_scan_rotary()
521 		report_rotary_event(keypad, 0, rotary_delta(kprec));  in pxa27x_keypad_scan_rotary()
524 		report_rotary_event(keypad, 1, rotary_delta(kprec >> 16));  in pxa27x_keypad_scan_rotary()
527 static void pxa27x_keypad_scan_direct(struct pxa27x_keypad *keypad)  in pxa27x_keypad_scan_direct()  argument
529 	const struct pxa27x_keypad_platform_data *pdata = keypad->pdata;  in pxa27x_keypad_scan_direct()
530 	struct input_dev *input_dev = keypad->input_dev;  in pxa27x_keypad_scan_direct()
538 		pxa27x_keypad_scan_rotary(keypad);  in pxa27x_keypad_scan_direct()
545 		new_state = ~KPDK_DK(kpdk) & keypad->direct_key_mask;  in pxa27x_keypad_scan_direct()
547 		new_state = KPDK_DK(kpdk) & keypad->direct_key_mask;  in pxa27x_keypad_scan_direct()
549 	bits_changed = keypad->direct_key_state ^ new_state;  in pxa27x_keypad_scan_direct()
559 			input_report_key(input_dev, keypad->keycodes[code],  in pxa27x_keypad_scan_direct()
564 	keypad->direct_key_state = new_state;  in pxa27x_keypad_scan_direct()
567 static void clear_wakeup_event(struct pxa27x_keypad *keypad)  in clear_wakeup_event()  argument
569 	const struct pxa27x_keypad_platform_data *pdata = keypad->pdata;  in clear_wakeup_event()
577 	struct pxa27x_keypad *keypad = dev_id;  in pxa27x_keypad_irq_handler()  local
580 	clear_wakeup_event(keypad);  in pxa27x_keypad_irq_handler()
583 		pxa27x_keypad_scan_direct(keypad);  in pxa27x_keypad_irq_handler()
586 		pxa27x_keypad_scan_matrix(keypad);  in pxa27x_keypad_irq_handler()
591 static void pxa27x_keypad_config(struct pxa27x_keypad *keypad)  in pxa27x_keypad_config()  argument
593 	const struct pxa27x_keypad_platform_data *pdata = keypad->pdata;  in pxa27x_keypad_config()
628 		keypad->direct_key_mask = pdata->direct_key_mask;  in pxa27x_keypad_config()
630 		keypad->direct_key_mask = ((1 << direct_key_num) - 1) & ~mask;  in pxa27x_keypad_config()
643 	struct pxa27x_keypad *keypad = input_get_drvdata(dev);  in pxa27x_keypad_open()  local
646 	ret = clk_prepare_enable(keypad->clk);  in pxa27x_keypad_open()
650 	pxa27x_keypad_config(keypad);  in pxa27x_keypad_open()
657 	struct pxa27x_keypad *keypad = input_get_drvdata(dev);  in pxa27x_keypad_close()  local
660 	clk_disable_unprepare(keypad->clk);  in pxa27x_keypad_close()
667 	struct pxa27x_keypad *keypad = platform_get_drvdata(pdev);  in pxa27x_keypad_suspend()  local
674 		enable_irq_wake(keypad->irq);  in pxa27x_keypad_suspend()
676 		clk_disable_unprepare(keypad->clk);  in pxa27x_keypad_suspend()
684 	struct pxa27x_keypad *keypad = platform_get_drvdata(pdev);  in pxa27x_keypad_resume()  local
685 	struct input_dev *input_dev = keypad->input_dev;  in pxa27x_keypad_resume()
693 		disable_irq_wake(keypad->irq);  in pxa27x_keypad_resume()
699 			ret = clk_prepare_enable(keypad->clk);  in pxa27x_keypad_resume()
701 				pxa27x_keypad_config(keypad);  in pxa27x_keypad_resume()
720 	struct pxa27x_keypad *keypad;  in pxa27x_keypad_probe()  local
739 	keypad = devm_kzalloc(&pdev->dev, sizeof(*keypad),  in pxa27x_keypad_probe()
741 	if (!keypad)  in pxa27x_keypad_probe()
748 	keypad->pdata = pdata;  in pxa27x_keypad_probe()
749 	keypad->input_dev = input_dev;  in pxa27x_keypad_probe()
750 	keypad->irq = irq;  in pxa27x_keypad_probe()
752 	keypad->mmio_base = devm_ioremap_resource(&pdev->dev, res);  in pxa27x_keypad_probe()
753 	if (IS_ERR(keypad->mmio_base))  in pxa27x_keypad_probe()
754 		return PTR_ERR(keypad->mmio_base);  in pxa27x_keypad_probe()
756 	keypad->clk = devm_clk_get(&pdev->dev, NULL);  in pxa27x_keypad_probe()
757 	if (IS_ERR(keypad->clk)) {  in pxa27x_keypad_probe()
759 		return PTR_ERR(keypad->clk);  in pxa27x_keypad_probe()
768 	input_dev->keycode = keypad->keycodes;  in pxa27x_keypad_probe()
769 	input_dev->keycodesize = sizeof(keypad->keycodes[0]);  in pxa27x_keypad_probe()
770 	input_dev->keycodemax = ARRAY_SIZE(keypad->keycodes);  in pxa27x_keypad_probe()
772 	input_set_drvdata(input_dev, keypad);  in pxa27x_keypad_probe()
778 		error = pxa27x_keypad_build_keycode(keypad);  in pxa27x_keypad_probe()
780 		error = pxa27x_keypad_build_keycode_from_dt(keypad);  in pxa27x_keypad_probe()
786 		pdata = keypad->pdata;  in pxa27x_keypad_probe()
793 	keypad->row_shift = get_count_order(pdata->matrix_key_cols);  in pxa27x_keypad_probe()
795 	if ((pdata->enable_rotary0 && keypad->rotary_rel_code[0] != -1) ||  in pxa27x_keypad_probe()
796 	    (pdata->enable_rotary1 && keypad->rotary_rel_code[1] != -1)) {  in pxa27x_keypad_probe()
801 				 0, pdev->name, keypad);  in pxa27x_keypad_probe()
814 	platform_set_drvdata(pdev, keypad);  in pxa27x_keypad_probe()