85 static int kbd_readl(struct omap4_keypad *keypad_data, u32 offset)  in kbd_readl()  argument
87 	return __raw_readl(keypad_data->base +  in kbd_readl()
88 				keypad_data->reg_offset + offset);  in kbd_readl()
91 static void kbd_writel(struct omap4_keypad *keypad_data, u32 offset, u32 value)  in kbd_writel()  argument
94 		     keypad_data->base + keypad_data->reg_offset + offset);  in kbd_writel()
97 static int kbd_read_irqreg(struct omap4_keypad *keypad_data, u32 offset)  in kbd_read_irqreg()  argument
99 	return __raw_readl(keypad_data->base +  in kbd_read_irqreg()
100 				keypad_data->irqreg_offset + offset);  in kbd_read_irqreg()
103 static void kbd_write_irqreg(struct omap4_keypad *keypad_data,  in kbd_write_irqreg()  argument
107 		     keypad_data->base + keypad_data->irqreg_offset + offset);  in kbd_write_irqreg()
114 	struct omap4_keypad *keypad_data = dev_id;  in omap4_keypad_irq_handler()  local
116 	if (kbd_read_irqreg(keypad_data, OMAP4_KBD_IRQSTATUS))  in omap4_keypad_irq_handler()
124 	struct omap4_keypad *keypad_data = dev_id;  in omap4_keypad_irq_thread_fn()  local
125 	struct input_dev *input_dev = keypad_data->input;  in omap4_keypad_irq_thread_fn()
126 	unsigned char key_state[ARRAY_SIZE(keypad_data->key_state)];  in omap4_keypad_irq_thread_fn()
130 	*new_state = kbd_readl(keypad_data, OMAP4_KBD_FULLCODE31_0);  in omap4_keypad_irq_thread_fn()
131 	*(new_state + 1) = kbd_readl(keypad_data, OMAP4_KBD_FULLCODE63_32);  in omap4_keypad_irq_thread_fn()
133 	for (row = 0; row < keypad_data->rows; row++) {  in omap4_keypad_irq_thread_fn()
134 		changed = key_state[row] ^ keypad_data->key_state[row];  in omap4_keypad_irq_thread_fn()
138 		for (col = 0; col < keypad_data->cols; col++) {  in omap4_keypad_irq_thread_fn()
141 						keypad_data->row_shift);  in omap4_keypad_irq_thread_fn()
144 						 keypad_data->keymap[code],  in omap4_keypad_irq_thread_fn()
152 	memcpy(keypad_data->key_state, key_state,  in omap4_keypad_irq_thread_fn()
153 		sizeof(keypad_data->key_state));  in omap4_keypad_irq_thread_fn()
156 	kbd_write_irqreg(keypad_data, OMAP4_KBD_IRQSTATUS,  in omap4_keypad_irq_thread_fn()
157 			 kbd_read_irqreg(keypad_data, OMAP4_KBD_IRQSTATUS));  in omap4_keypad_irq_thread_fn()
164 	struct omap4_keypad *keypad_data = input_get_drvdata(input);  in omap4_keypad_open()  local
168 	disable_irq(keypad_data->irq);  in omap4_keypad_open()
170 	kbd_writel(keypad_data, OMAP4_KBD_CTRL,  in omap4_keypad_open()
173 	kbd_writel(keypad_data, OMAP4_KBD_DEBOUNCINGTIME,  in omap4_keypad_open()
176 	kbd_write_irqreg(keypad_data, OMAP4_KBD_IRQSTATUS,  in omap4_keypad_open()
177 			 kbd_read_irqreg(keypad_data, OMAP4_KBD_IRQSTATUS));  in omap4_keypad_open()
178 	kbd_write_irqreg(keypad_data, OMAP4_KBD_IRQENABLE,  in omap4_keypad_open()
181 	kbd_writel(keypad_data, OMAP4_KBD_WAKEUPENABLE,  in omap4_keypad_open()
184 	enable_irq(keypad_data->irq);  in omap4_keypad_open()
189 static void omap4_keypad_stop(struct omap4_keypad *keypad_data)  in omap4_keypad_stop()  argument
192 	kbd_write_irqreg(keypad_data, OMAP4_KBD_IRQENABLE,  in omap4_keypad_stop()
194 	kbd_writel(keypad_data, OMAP4_KBD_WAKEUPENABLE, 0);  in omap4_keypad_stop()
197 	kbd_write_irqreg(keypad_data, OMAP4_KBD_IRQSTATUS,  in omap4_keypad_stop()
198 			 kbd_read_irqreg(keypad_data, OMAP4_KBD_IRQSTATUS));  in omap4_keypad_stop()
203 	struct omap4_keypad *keypad_data;  in omap4_keypad_close()  local
205 	keypad_data = input_get_drvdata(input);  in omap4_keypad_close()
206 	disable_irq(keypad_data->irq);  in omap4_keypad_close()
207 	omap4_keypad_stop(keypad_data);  in omap4_keypad_close()
208 	enable_irq(keypad_data->irq);  in omap4_keypad_close()
214 				 struct omap4_keypad *keypad_data)  in omap4_keypad_parse_dt()  argument
219 	err = matrix_keypad_parse_properties(dev, &keypad_data->rows,  in omap4_keypad_parse_dt()
220 					     &keypad_data->cols);  in omap4_keypad_parse_dt()
225 		keypad_data->no_autorepeat = true;  in omap4_keypad_parse_dt()
231 				       struct omap4_keypad *keypad_data)  in omap4_keypad_check_revision()  argument
235 	rev = __raw_readl(keypad_data->base + OMAP4_KBD_REVISION);  in omap4_keypad_check_revision()
240 		keypad_data->reg_offset = 0x00;  in omap4_keypad_check_revision()
241 		keypad_data->irqreg_offset = 0x00;  in omap4_keypad_check_revision()
244 		keypad_data->reg_offset = 0x10;  in omap4_keypad_check_revision()
245 		keypad_data->irqreg_offset = 0x0c;  in omap4_keypad_check_revision()
257 	struct omap4_keypad *keypad_data;  in omap4_keypad_probe()  local
274 	keypad_data = kzalloc(sizeof(struct omap4_keypad), GFP_KERNEL);  in omap4_keypad_probe()
275 	if (!keypad_data) {  in omap4_keypad_probe()
280 	keypad_data->irq = irq;  in omap4_keypad_probe()
282 	error = omap4_keypad_parse_dt(&pdev->dev, keypad_data);  in omap4_keypad_probe()
293 	keypad_data->base = ioremap(res->start, resource_size(res));  in omap4_keypad_probe()
294 	if (!keypad_data->base) {  in omap4_keypad_probe()
312 						    keypad_data);  in omap4_keypad_probe()
315 			omap4_keypad_stop(keypad_data);  in omap4_keypad_probe()
323 	keypad_data->input = input_dev = input_allocate_device();  in omap4_keypad_probe()
340 	if (!keypad_data->no_autorepeat)  in omap4_keypad_probe()
343 	input_set_drvdata(input_dev, keypad_data);  in omap4_keypad_probe()
345 	keypad_data->row_shift = get_count_order(keypad_data->cols);  in omap4_keypad_probe()
346 	max_keys = keypad_data->rows << keypad_data->row_shift;  in omap4_keypad_probe()
347 	keypad_data->keymap = kcalloc(max_keys,  in omap4_keypad_probe()
348 				      sizeof(keypad_data->keymap[0]),  in omap4_keypad_probe()
350 	if (!keypad_data->keymap) {  in omap4_keypad_probe()
357 					   keypad_data->rows, keypad_data->cols,  in omap4_keypad_probe()
358 					   keypad_data->keymap, input_dev);  in omap4_keypad_probe()
364 	error = request_threaded_irq(keypad_data->irq, omap4_keypad_irq_handler,  in omap4_keypad_probe()
366 				     "omap4-keypad", keypad_data);  in omap4_keypad_probe()
372 	error = input_register_device(keypad_data->input);  in omap4_keypad_probe()
379 	platform_set_drvdata(pdev, keypad_data);  in omap4_keypad_probe()
384 	free_irq(keypad_data->irq, keypad_data);  in omap4_keypad_probe()
386 	kfree(keypad_data->keymap);  in omap4_keypad_probe()
391 	iounmap(keypad_data->base);  in omap4_keypad_probe()
395 	kfree(keypad_data);  in omap4_keypad_probe()
401 	struct omap4_keypad *keypad_data = platform_get_drvdata(pdev);  in omap4_keypad_remove()  local
404 	free_irq(keypad_data->irq, keypad_data);  in omap4_keypad_remove()
408 	input_unregister_device(keypad_data->input);  in omap4_keypad_remove()
410 	iounmap(keypad_data->base);  in omap4_keypad_remove()
415 	kfree(keypad_data->keymap);  in omap4_keypad_remove()
416 	kfree(keypad_data);  in omap4_keypad_remove()
431 	struct omap4_keypad *keypad_data = platform_get_drvdata(pdev);  in omap4_keypad_suspend()  local
435 		error = enable_irq_wake(keypad_data->irq);  in omap4_keypad_suspend()
437 			keypad_data->irq_wake_enabled = true;  in omap4_keypad_suspend()
446 	struct omap4_keypad *keypad_data = platform_get_drvdata(pdev);  in omap4_keypad_resume()  local
448 	if (device_may_wakeup(&pdev->dev) && keypad_data->irq_wake_enabled) {  in omap4_keypad_resume()
449 		disable_irq_wake(keypad_data->irq);  in omap4_keypad_resume()
450 		keypad_data->irq_wake_enabled = false;  in omap4_keypad_resume()