88 static int kbd_readl(struct omap4_keypad *keypad_data, u32 offset)  in kbd_readl()  argument
90 	return __raw_readl(keypad_data->base +  in kbd_readl()
91 				keypad_data->reg_offset + offset);  in kbd_readl()
94 static void kbd_writel(struct omap4_keypad *keypad_data, u32 offset, u32 value)  in kbd_writel()  argument
97 		     keypad_data->base + keypad_data->reg_offset + offset);  in kbd_writel()
100 static int kbd_read_irqreg(struct omap4_keypad *keypad_data, u32 offset)  in kbd_read_irqreg()  argument
102 	return __raw_readl(keypad_data->base +  in kbd_read_irqreg()
103 				keypad_data->irqreg_offset + offset);  in kbd_read_irqreg()
106 static void kbd_write_irqreg(struct omap4_keypad *keypad_data,  in kbd_write_irqreg()  argument
110 		     keypad_data->base + keypad_data->irqreg_offset + offset);  in kbd_write_irqreg()
113 static int omap4_keypad_report_keys(struct omap4_keypad *keypad_data,  in omap4_keypad_report_keys()  argument
116 	struct input_dev *input_dev = keypad_data->input;  in omap4_keypad_report_keys()
124 	for_each_set_bit(bit, mask, keypad_data->rows * BITS_PER_BYTE) {  in omap4_keypad_report_keys()
127 		code = MATRIX_SCAN_CODE(row, col, keypad_data->row_shift);  in omap4_keypad_report_keys()
130 		input_report_key(input_dev, keypad_data->keymap[code], down);  in omap4_keypad_report_keys()
141 static void omap4_keypad_scan_keys(struct omap4_keypad *keypad_data, u64 keys)  in omap4_keypad_scan_keys()  argument
145 	mutex_lock(&keypad_data->lock);  in omap4_keypad_scan_keys()
147 	changed = keys ^ keypad_data->keys;  in omap4_keypad_scan_keys()
153 	omap4_keypad_report_keys(keypad_data, changed & ~keys, false);  in omap4_keypad_scan_keys()
156 	omap4_keypad_report_keys(keypad_data, changed & keys, true);  in omap4_keypad_scan_keys()
158 	keypad_data->keys = keys;  in omap4_keypad_scan_keys()
160 	mutex_unlock(&keypad_data->lock);  in omap4_keypad_scan_keys()
166 	struct omap4_keypad *keypad_data = dev_id;  in omap4_keypad_irq_handler()  local
168 	if (kbd_read_irqreg(keypad_data, OMAP4_KBD_IRQSTATUS))  in omap4_keypad_irq_handler()
176 	struct omap4_keypad *keypad_data = dev_id;  in omap4_keypad_irq_thread_fn()  local
177 	struct device *dev = keypad_data->input->dev.parent;  in omap4_keypad_irq_thread_fn()
186 	low = kbd_readl(keypad_data, OMAP4_KBD_FULLCODE31_0);  in omap4_keypad_irq_thread_fn()
187 	high = kbd_readl(keypad_data, OMAP4_KBD_FULLCODE63_32);  in omap4_keypad_irq_thread_fn()
190 	omap4_keypad_scan_keys(keypad_data, keys);  in omap4_keypad_irq_thread_fn()
193 	kbd_write_irqreg(keypad_data, OMAP4_KBD_IRQSTATUS,  in omap4_keypad_irq_thread_fn()
194 			 kbd_read_irqreg(keypad_data, OMAP4_KBD_IRQSTATUS));  in omap4_keypad_irq_thread_fn()
204 	struct omap4_keypad *keypad_data = input_get_drvdata(input);  in omap4_keypad_open()  local
212 	disable_irq(keypad_data->irq);  in omap4_keypad_open()
214 	kbd_writel(keypad_data, OMAP4_KBD_CTRL,  in omap4_keypad_open()
217 	kbd_writel(keypad_data, OMAP4_KBD_DEBOUNCINGTIME,  in omap4_keypad_open()
220 	kbd_write_irqreg(keypad_data, OMAP4_KBD_IRQSTATUS,  in omap4_keypad_open()
221 			 kbd_read_irqreg(keypad_data, OMAP4_KBD_IRQSTATUS));  in omap4_keypad_open()
222 	kbd_write_irqreg(keypad_data, OMAP4_KBD_IRQENABLE,  in omap4_keypad_open()
224 	kbd_writel(keypad_data, OMAP4_KBD_WAKEUPENABLE,  in omap4_keypad_open()
227 	enable_irq(keypad_data->irq);  in omap4_keypad_open()
235 static void omap4_keypad_stop(struct omap4_keypad *keypad_data)  in omap4_keypad_stop()  argument
238 	kbd_write_irqreg(keypad_data, OMAP4_KBD_IRQENABLE,  in omap4_keypad_stop()
240 	kbd_writel(keypad_data, OMAP4_KBD_WAKEUPENABLE, 0);  in omap4_keypad_stop()
243 	kbd_write_irqreg(keypad_data, OMAP4_KBD_IRQSTATUS,  in omap4_keypad_stop()
244 			 kbd_read_irqreg(keypad_data, OMAP4_KBD_IRQSTATUS));  in omap4_keypad_stop()
249 	struct omap4_keypad *keypad_data = input_get_drvdata(input);  in omap4_keypad_close()  local
258 	disable_irq(keypad_data->irq);  in omap4_keypad_close()
259 	omap4_keypad_stop(keypad_data);  in omap4_keypad_close()
260 	enable_irq(keypad_data->irq);  in omap4_keypad_close()
267 				 struct omap4_keypad *keypad_data)  in omap4_keypad_parse_dt()  argument
272 	err = matrix_keypad_parse_properties(dev, &keypad_data->rows,  in omap4_keypad_parse_dt()
273 					     &keypad_data->cols);  in omap4_keypad_parse_dt()
277 	keypad_data->no_autorepeat = of_property_read_bool(np, "linux,input-no-autorepeat");  in omap4_keypad_parse_dt()
283 				       struct omap4_keypad *keypad_data)  in omap4_keypad_check_revision()  argument
287 	rev = __raw_readl(keypad_data->base + OMAP4_KBD_REVISION);  in omap4_keypad_check_revision()
292 		keypad_data->reg_offset = 0x00;  in omap4_keypad_check_revision()
293 		keypad_data->irqreg_offset = 0x00;  in omap4_keypad_check_revision()
296 		keypad_data->reg_offset = 0x10;  in omap4_keypad_check_revision()
297 		keypad_data->irqreg_offset = 0x0c;  in omap4_keypad_check_revision()
315 	struct omap4_keypad *keypad_data = platform_get_drvdata(pdev);  in omap4_keypad_runtime_suspend()  local
318 	active = kbd_readl(keypad_data, OMAP4_KBD_STATEMACHINE);  in omap4_keypad_runtime_suspend()
324 	omap4_keypad_scan_keys(keypad_data, 0);  in omap4_keypad_runtime_suspend()
342 	struct omap4_keypad *keypad_data;  in omap4_keypad_probe()  local
352 	keypad_data = devm_kzalloc(dev, sizeof(*keypad_data), GFP_KERNEL);  in omap4_keypad_probe()
353 	if (!keypad_data) {  in omap4_keypad_probe()
358 	keypad_data->irq = irq;  in omap4_keypad_probe()
359 	mutex_init(&keypad_data->lock);  in omap4_keypad_probe()
360 	platform_set_drvdata(pdev, keypad_data);  in omap4_keypad_probe()
362 	error = omap4_keypad_parse_dt(dev, keypad_data);  in omap4_keypad_probe()
366 	keypad_data->base = devm_platform_ioremap_resource(pdev, 0);  in omap4_keypad_probe()
367 	if (IS_ERR(keypad_data->base))  in omap4_keypad_probe()
368 		return PTR_ERR(keypad_data->base);  in omap4_keypad_probe()
390 	error = omap4_keypad_check_revision(dev, keypad_data);  in omap4_keypad_probe()
393 		omap4_keypad_stop(keypad_data);  in omap4_keypad_probe()
402 	keypad_data->input = input_dev = devm_input_allocate_device(dev);  in omap4_keypad_probe()
416 	if (!keypad_data->no_autorepeat)  in omap4_keypad_probe()
419 	input_set_drvdata(input_dev, keypad_data);  in omap4_keypad_probe()
421 	keypad_data->row_shift = get_count_order(keypad_data->cols);  in omap4_keypad_probe()
422 	max_keys = keypad_data->rows << keypad_data->row_shift;  in omap4_keypad_probe()
423 	keypad_data->keymap = devm_kcalloc(dev,  in omap4_keypad_probe()
425 					   sizeof(keypad_data->keymap[0]),  in omap4_keypad_probe()
427 	if (!keypad_data->keymap) {  in omap4_keypad_probe()
433 					   keypad_data->rows, keypad_data->cols,  in omap4_keypad_probe()
434 					   keypad_data->keymap, input_dev);  in omap4_keypad_probe()
440 	error = devm_request_threaded_irq(dev, keypad_data->irq,  in omap4_keypad_probe()
444 					  "omap4-keypad", keypad_data);  in omap4_keypad_probe()
450 	error = input_register_device(keypad_data->input);  in omap4_keypad_probe()
457 	error = dev_pm_set_wake_irq(dev, keypad_data->irq);  in omap4_keypad_probe()