55 static void __activate_col(struct matrix_keypad *keypad, int col, bool on)  in __activate_col()  argument
58 		gpiod_direction_output(keypad->col_gpios[col], 1);  in __activate_col()
60 		gpiod_set_value_cansleep(keypad->col_gpios[col], 0);  in __activate_col()
61 		if (!keypad->drive_inactive_cols)  in __activate_col()
62 			gpiod_direction_input(keypad->col_gpios[col]);  in __activate_col()
66 static void activate_col(struct matrix_keypad *keypad, int col, bool on)  in activate_col()  argument
68 	__activate_col(keypad, col, on);  in activate_col()
70 	if (on && keypad->col_scan_delay_us)  in activate_col()
71 		udelay(keypad->col_scan_delay_us);  in activate_col()
74 static void activate_all_cols(struct matrix_keypad *keypad, bool on)  in activate_all_cols()  argument
78 	for (col = 0; col < keypad->num_col_gpios; col++)  in activate_all_cols()
79 		__activate_col(keypad, col, on);  in activate_all_cols()
82 static bool row_asserted(struct matrix_keypad *keypad, int row)  in row_asserted()  argument
84 	return gpiod_get_value_cansleep(keypad->row_gpios[row]);  in row_asserted()
87 static void enable_row_irqs(struct matrix_keypad *keypad)  in enable_row_irqs()  argument
91 	for (i = 0; i < keypad->num_row_gpios; i++)  in enable_row_irqs()
92 		enable_irq(keypad->row_irqs[i]);  in enable_row_irqs()
95 static void disable_row_irqs(struct matrix_keypad *keypad)  in disable_row_irqs()  argument
99 	for (i = 0; i < keypad->num_row_gpios; i++)  in disable_row_irqs()
100 		disable_irq_nosync(keypad->row_irqs[i]);  in disable_row_irqs()
108 	struct matrix_keypad *keypad =  in matrix_keypad_scan()  local
110 	struct input_dev *input_dev = keypad->input_dev;  in matrix_keypad_scan()
116 	activate_all_cols(keypad, false);  in matrix_keypad_scan()
120 	for (row = 0; row < keypad->num_row_gpios; row++)  in matrix_keypad_scan()
121 		gpiod_direction_input(keypad->row_gpios[row]);  in matrix_keypad_scan()
124 	for (col = 0; col < keypad->num_col_gpios; col++) {  in matrix_keypad_scan()
126 		activate_col(keypad, col, true);  in matrix_keypad_scan()
128 		for (row = 0; row < keypad->num_row_gpios; row++)  in matrix_keypad_scan()
130 				row_asserted(keypad, row) ? BIT(row) : 0;  in matrix_keypad_scan()
132 		activate_col(keypad, col, false);  in matrix_keypad_scan()
135 	for (col = 0; col < keypad->num_col_gpios; col++) {  in matrix_keypad_scan()
138 		bits_changed = keypad->last_key_state[col] ^ new_state[col];  in matrix_keypad_scan()
142 		for (row = 0; row < keypad->num_row_gpios; row++) {  in matrix_keypad_scan()
146 			code = MATRIX_SCAN_CODE(row, col, keypad->row_shift);  in matrix_keypad_scan()
155 	memcpy(keypad->last_key_state, new_state, sizeof(new_state));  in matrix_keypad_scan()
157 	activate_all_cols(keypad, true);  in matrix_keypad_scan()
160 	scoped_guard(spinlock_irq, &keypad->lock) {  in matrix_keypad_scan()
161 		keypad->scan_pending = false;  in matrix_keypad_scan()
162 		enable_row_irqs(keypad);  in matrix_keypad_scan()
168 	struct matrix_keypad *keypad = id;  in matrix_keypad_interrupt()  local
170 	guard(spinlock_irqsave)(&keypad->lock);  in matrix_keypad_interrupt()
177 	if (unlikely(keypad->scan_pending || keypad->stopped))  in matrix_keypad_interrupt()
180 	disable_row_irqs(keypad);  in matrix_keypad_interrupt()
181 	keypad->scan_pending = true;  in matrix_keypad_interrupt()
182 	schedule_delayed_work(&keypad->work,  in matrix_keypad_interrupt()
183 			      msecs_to_jiffies(keypad->debounce_ms));  in matrix_keypad_interrupt()
191 	struct matrix_keypad *keypad = input_get_drvdata(dev);  in matrix_keypad_start()  local
193 	keypad->stopped = false;  in matrix_keypad_start()
200 	schedule_delayed_work(&keypad->work, 0);  in matrix_keypad_start()
207 	struct matrix_keypad *keypad = input_get_drvdata(dev);  in matrix_keypad_stop()  local
209 	scoped_guard(spinlock_irq, &keypad->lock) {  in matrix_keypad_stop()
210 		keypad->stopped = true;  in matrix_keypad_stop()
213 	flush_delayed_work(&keypad->work);  in matrix_keypad_stop()
218 	disable_row_irqs(keypad);  in matrix_keypad_stop()
221 static void matrix_keypad_enable_wakeup(struct matrix_keypad *keypad)  in matrix_keypad_enable_wakeup()  argument
225 	for_each_clear_bit(i, keypad->wakeup_enabled_irqs,  in matrix_keypad_enable_wakeup()
226 			   keypad->num_row_gpios)  in matrix_keypad_enable_wakeup()
227 		if (enable_irq_wake(keypad->row_irqs[i]) == 0)  in matrix_keypad_enable_wakeup()
228 			__set_bit(i, keypad->wakeup_enabled_irqs);  in matrix_keypad_enable_wakeup()
231 static void matrix_keypad_disable_wakeup(struct matrix_keypad *keypad)  in matrix_keypad_disable_wakeup()  argument
235 	for_each_set_bit(i, keypad->wakeup_enabled_irqs,  in matrix_keypad_disable_wakeup()
236 			 keypad->num_row_gpios) {  in matrix_keypad_disable_wakeup()
237 		disable_irq_wake(keypad->row_irqs[i]);  in matrix_keypad_disable_wakeup()
238 		__clear_bit(i, keypad->wakeup_enabled_irqs);  in matrix_keypad_disable_wakeup()
245 	struct matrix_keypad *keypad = platform_get_drvdata(pdev);  in matrix_keypad_suspend()  local
247 	matrix_keypad_stop(keypad->input_dev);  in matrix_keypad_suspend()
250 		matrix_keypad_enable_wakeup(keypad);  in matrix_keypad_suspend()
258 	struct matrix_keypad *keypad = platform_get_drvdata(pdev);  in matrix_keypad_resume()  local
261 		matrix_keypad_disable_wakeup(keypad);  in matrix_keypad_resume()
263 	matrix_keypad_start(keypad->input_dev);  in matrix_keypad_resume()
272 				   struct matrix_keypad *keypad)  in matrix_keypad_init_gpio()  argument
286 	keypad->num_row_gpios = nrow;  in matrix_keypad_init_gpio()
287 	keypad->num_col_gpios = ncol;  in matrix_keypad_init_gpio()
292 	for (i = 0; i < keypad->num_col_gpios; i++) {  in matrix_keypad_init_gpio()
293 		keypad->col_gpios[i] = devm_gpiod_get_index(&pdev->dev, "col",  in matrix_keypad_init_gpio()
295 		err = PTR_ERR_OR_ZERO(keypad->col_gpios[i]);  in matrix_keypad_init_gpio()
303 		gpiod_set_consumer_name(keypad->col_gpios[i], "matrix_kbd_col");  in matrix_keypad_init_gpio()
305 		if (active_low ^ gpiod_is_active_low(keypad->col_gpios[i]))  in matrix_keypad_init_gpio()
306 			gpiod_toggle_active_low(keypad->col_gpios[i]);  in matrix_keypad_init_gpio()
308 		gpiod_direction_output(keypad->col_gpios[i], 1);  in matrix_keypad_init_gpio()
311 	for (i = 0; i < keypad->num_row_gpios; i++) {  in matrix_keypad_init_gpio()
312 		keypad->row_gpios[i] = devm_gpiod_get_index(&pdev->dev, "row",  in matrix_keypad_init_gpio()
314 		err = PTR_ERR_OR_ZERO(keypad->row_gpios[i]);  in matrix_keypad_init_gpio()
322 		gpiod_set_consumer_name(keypad->row_gpios[i], "matrix_kbd_row");  in matrix_keypad_init_gpio()
324 		if (active_low ^ gpiod_is_active_low(keypad->row_gpios[i]))  in matrix_keypad_init_gpio()
325 			gpiod_toggle_active_low(keypad->row_gpios[i]);  in matrix_keypad_init_gpio()
332 					  struct matrix_keypad *keypad)  in matrix_keypad_setup_interrupts()  argument
338 	for (i = 0; i < keypad->num_row_gpios; i++) {  in matrix_keypad_setup_interrupts()
339 		irq = gpiod_to_irq(keypad->row_gpios[i]);  in matrix_keypad_setup_interrupts()
352 						   "matrix-keypad", keypad);  in matrix_keypad_setup_interrupts()
360 		keypad->row_irqs[i] = irq;  in matrix_keypad_setup_interrupts()
364 	disable_row_irqs(keypad);  in matrix_keypad_setup_interrupts()
371 	struct matrix_keypad *keypad;  in matrix_keypad_probe()  local
376 	keypad = devm_kzalloc(&pdev->dev, sizeof(*keypad), GFP_KERNEL);  in matrix_keypad_probe()
377 	if (!keypad)  in matrix_keypad_probe()
384 	keypad->input_dev = input_dev;  in matrix_keypad_probe()
385 	keypad->stopped = true;  in matrix_keypad_probe()
386 	INIT_DELAYED_WORK(&keypad->work, matrix_keypad_scan);  in matrix_keypad_probe()
387 	spin_lock_init(&keypad->lock);  in matrix_keypad_probe()
389 	keypad->drive_inactive_cols =  in matrix_keypad_probe()
392 				 &keypad->debounce_ms);  in matrix_keypad_probe()
394 				 &keypad->col_scan_delay_us);  in matrix_keypad_probe()
396 	err = matrix_keypad_init_gpio(pdev, keypad);  in matrix_keypad_probe()
400 	keypad->row_shift = get_count_order(keypad->num_col_gpios);  in matrix_keypad_probe()
402 	err = matrix_keypad_setup_interrupts(pdev, keypad);  in matrix_keypad_probe()
412 					 keypad->num_row_gpios,  in matrix_keypad_probe()
413 					 keypad->num_col_gpios,  in matrix_keypad_probe()
424 	input_set_drvdata(input_dev, keypad);  in matrix_keypad_probe()
426 	err = input_register_device(keypad->input_dev);  in matrix_keypad_probe()
435 	platform_set_drvdata(pdev, keypad);  in matrix_keypad_probe()
442 	{ .compatible = "gpio-matrix-keypad" },
451 		.name	= "matrix-keypad",
459 MODULE_DESCRIPTION("GPIO Driven Matrix Keypad Driver");
461 MODULE_ALIAS("platform:matrix-keypad");