391 	struct adp5589_kpad *kpad = gpiochip_get_data(chip);  in adp5589_gpio_get_value()  local
392 	unsigned int bank = kpad->var->bank(kpad->gpiomap[off]);  in adp5589_gpio_get_value()
393 	unsigned int bit = kpad->var->bit(kpad->gpiomap[off]);  in adp5589_gpio_get_value()
395 	return !!(adp5589_read(kpad->client,  in adp5589_gpio_get_value()
396 			       kpad->var->reg(ADP5589_GPI_STATUS_A) + bank) &  in adp5589_gpio_get_value()
403 	struct adp5589_kpad *kpad = gpiochip_get_data(chip);  in adp5589_gpio_set_value()  local
404 	unsigned int bank = kpad->var->bank(kpad->gpiomap[off]);  in adp5589_gpio_set_value()
405 	unsigned int bit = kpad->var->bit(kpad->gpiomap[off]);  in adp5589_gpio_set_value()
407 	mutex_lock(&kpad->gpio_lock);  in adp5589_gpio_set_value()
410 		kpad->dat_out[bank] |= bit;  in adp5589_gpio_set_value()
412 		kpad->dat_out[bank] &= ~bit;  in adp5589_gpio_set_value()
414 	adp5589_write(kpad->client, kpad->var->reg(ADP5589_GPO_DATA_OUT_A) +  in adp5589_gpio_set_value()
415 		      bank, kpad->dat_out[bank]);  in adp5589_gpio_set_value()
417 	mutex_unlock(&kpad->gpio_lock);  in adp5589_gpio_set_value()
422 	struct adp5589_kpad *kpad = gpiochip_get_data(chip);  in adp5589_gpio_direction_input()  local
423 	unsigned int bank = kpad->var->bank(kpad->gpiomap[off]);  in adp5589_gpio_direction_input()
424 	unsigned int bit = kpad->var->bit(kpad->gpiomap[off]);  in adp5589_gpio_direction_input()
427 	mutex_lock(&kpad->gpio_lock);  in adp5589_gpio_direction_input()
429 	kpad->dir[bank] &= ~bit;  in adp5589_gpio_direction_input()
430 	ret = adp5589_write(kpad->client,  in adp5589_gpio_direction_input()
431 			    kpad->var->reg(ADP5589_GPIO_DIRECTION_A) + bank,  in adp5589_gpio_direction_input()
432 			    kpad->dir[bank]);  in adp5589_gpio_direction_input()
434 	mutex_unlock(&kpad->gpio_lock);  in adp5589_gpio_direction_input()
442 	struct adp5589_kpad *kpad = gpiochip_get_data(chip);  in adp5589_gpio_direction_output()  local
443 	unsigned int bank = kpad->var->bank(kpad->gpiomap[off]);  in adp5589_gpio_direction_output()
444 	unsigned int bit = kpad->var->bit(kpad->gpiomap[off]);  in adp5589_gpio_direction_output()
447 	mutex_lock(&kpad->gpio_lock);  in adp5589_gpio_direction_output()
449 	kpad->dir[bank] |= bit;  in adp5589_gpio_direction_output()
452 		kpad->dat_out[bank] |= bit;  in adp5589_gpio_direction_output()
454 		kpad->dat_out[bank] &= ~bit;  in adp5589_gpio_direction_output()
456 	ret = adp5589_write(kpad->client, kpad->var->reg(ADP5589_GPO_DATA_OUT_A)  in adp5589_gpio_direction_output()
457 			    + bank, kpad->dat_out[bank]);  in adp5589_gpio_direction_output()
458 	ret |= adp5589_write(kpad->client,  in adp5589_gpio_direction_output()
459 			     kpad->var->reg(ADP5589_GPIO_DIRECTION_A) + bank,  in adp5589_gpio_direction_output()
460 			     kpad->dir[bank]);  in adp5589_gpio_direction_output()
462 	mutex_unlock(&kpad->gpio_lock);  in adp5589_gpio_direction_output()
467 static int adp5589_build_gpiomap(struct adp5589_kpad *kpad,  in adp5589_build_gpiomap()  argument
476 	for (i = 0; i < kpad->var->maxgpio; i++)  in adp5589_build_gpiomap()
480 	for (i = 0; i < kpad->gpimapsize; i++)  in adp5589_build_gpiomap()
481 		pin_used[kpad->gpimap[i].pin - kpad->var->gpi_pin_base] = true;  in adp5589_build_gpiomap()
483 	if (kpad->extend_cfg & R4_EXTEND_CFG)  in adp5589_build_gpiomap()
486 	if (kpad->extend_cfg & C4_EXTEND_CFG)  in adp5589_build_gpiomap()
487 		pin_used[kpad->var->c4_extend_cfg] = true;  in adp5589_build_gpiomap()
489 	if (!kpad->support_row5)  in adp5589_build_gpiomap()
492 	for (i = 0; i < kpad->var->maxgpio; i++)  in adp5589_build_gpiomap()
494 			kpad->gpiomap[n_unused++] = i;  in adp5589_build_gpiomap()
499 static int adp5589_gpio_add(struct adp5589_kpad *kpad)  in adp5589_gpio_add()  argument
501 	struct device *dev = &kpad->client->dev;  in adp5589_gpio_add()
509 	kpad->gc.parent = dev;  in adp5589_gpio_add()
510 	kpad->gc.ngpio = adp5589_build_gpiomap(kpad, pdata);  in adp5589_gpio_add()
511 	if (kpad->gc.ngpio == 0) {  in adp5589_gpio_add()
516 	kpad->gc.direction_input = adp5589_gpio_direction_input;  in adp5589_gpio_add()
517 	kpad->gc.direction_output = adp5589_gpio_direction_output;  in adp5589_gpio_add()
518 	kpad->gc.get = adp5589_gpio_get_value;  in adp5589_gpio_add()
519 	kpad->gc.set = adp5589_gpio_set_value;  in adp5589_gpio_add()
520 	kpad->gc.can_sleep = 1;  in adp5589_gpio_add()
522 	kpad->gc.base = gpio_data->gpio_start;  in adp5589_gpio_add()
523 	kpad->gc.label = kpad->client->name;  in adp5589_gpio_add()
524 	kpad->gc.owner = THIS_MODULE;  in adp5589_gpio_add()
526 	mutex_init(&kpad->gpio_lock);  in adp5589_gpio_add()
528 	error = devm_gpiochip_add_data(dev, &kpad->gc, kpad);  in adp5589_gpio_add()
532 	for (i = 0; i <= kpad->var->bank(kpad->var->maxgpio); i++) {  in adp5589_gpio_add()
533 		kpad->dat_out[i] = adp5589_read(kpad->client, kpad->var->reg(  in adp5589_gpio_add()
535 		kpad->dir[i] = adp5589_read(kpad->client, kpad->var->reg(  in adp5589_gpio_add()
542 static inline int adp5589_gpio_add(struct adp5589_kpad *kpad)  in adp5589_gpio_add()  argument
548 static void adp5589_report_switches(struct adp5589_kpad *kpad,  in adp5589_report_switches()  argument
553 	for (i = 0; i < kpad->gpimapsize; i++) {  in adp5589_report_switches()
554 		if (key_val == kpad->gpimap[i].pin) {  in adp5589_report_switches()
555 			input_report_switch(kpad->input,  in adp5589_report_switches()
556 					    kpad->gpimap[i].sw_evt,  in adp5589_report_switches()
563 static void adp5589_report_events(struct adp5589_kpad *kpad, int ev_cnt)  in adp5589_report_events()  argument
568 		int key = adp5589_read(kpad->client, ADP5589_5_FIFO_1 + i);  in adp5589_report_events()
571 		if (key_val >= kpad->var->gpi_pin_base &&  in adp5589_report_events()
572 		    key_val <= kpad->var->gpi_pin_end) {  in adp5589_report_events()
573 			adp5589_report_switches(kpad, key, key_val);  in adp5589_report_events()
575 			input_report_key(kpad->input,  in adp5589_report_events()
576 					 kpad->keycode[key_val - 1],  in adp5589_report_events()
584 	struct adp5589_kpad *kpad = handle;  in adp5589_irq()  local
585 	struct i2c_client *client = kpad->client;  in adp5589_irq()
596 			adp5589_report_events(kpad, ev_cnt);  in adp5589_irq()
597 			input_sync(kpad->input);  in adp5589_irq()
606 static int adp5589_get_evcode(struct adp5589_kpad *kpad, unsigned short key)  in adp5589_get_evcode()  argument
610 	for (i = 0; i < kpad->var->keymapsize; i++)  in adp5589_get_evcode()
611 		if (key == kpad->keycode[i])  in adp5589_get_evcode()
614 	dev_err(&kpad->client->dev, "RESET/UNLOCK key not in keycode map\n");  in adp5589_get_evcode()
619 static int adp5589_setup(struct adp5589_kpad *kpad)  in adp5589_setup()  argument
621 	struct i2c_client *client = kpad->client;  in adp5589_setup()
624 	u8 (*reg) (u8) = kpad->var->reg;  in adp5589_setup()
630 			    pdata->keypad_en_mask & kpad->var->row_mask);  in adp5589_setup()
632 			     (pdata->keypad_en_mask >> kpad->var->col_shift) &  in adp5589_setup()
633 			     kpad->var->col_mask);  in adp5589_setup()
635 	if (!kpad->is_adp5585)  in adp5589_setup()
639 	if (!kpad->is_adp5585 && pdata->en_keylock) {  in adp5589_setup()
655 		if (pin <= kpad->var->gpi_pin_row_end) {  in adp5589_setup()
656 			evt_mode1 |= BIT(pin - kpad->var->gpi_pin_row_base);  in adp5589_setup()
659 			    BIT(pin - kpad->var->gpi_pin_col_base) & 0xFF;  in adp5589_setup()
660 			if (!kpad->is_adp5585)  in adp5589_setup()
662 				    BIT(pin - kpad->var->gpi_pin_col_base) >> 8;  in adp5589_setup()
671 		if (!kpad->is_adp5585)  in adp5589_setup()
681 	for (i = 0; i <= kpad->var->max_row_num; i++) {  in adp5589_setup()
694 		if (i % 4 == 3 || i == kpad->var->max_row_num) {  in adp5589_setup()
701 	for (i = 0; i <= kpad->var->max_col_num; i++) {  in adp5589_setup()
702 		unsigned int val = 0, bit = BIT(i + kpad->var->col_shift);  in adp5589_setup()
714 		if (i % 4 == 3 || i == kpad->var->max_col_num) {  in adp5589_setup()
724 				     adp5589_get_evcode(kpad,  in adp5589_setup()
727 				     adp5589_get_evcode(kpad,  in adp5589_setup()
730 				     adp5589_get_evcode(kpad,  in adp5589_setup()
732 		kpad->extend_cfg |= R4_EXTEND_CFG;  in adp5589_setup()
737 				     adp5589_get_evcode(kpad,  in adp5589_setup()
740 				     adp5589_get_evcode(kpad,  in adp5589_setup()
742 		kpad->extend_cfg |= C4_EXTEND_CFG;  in adp5589_setup()
745 	if (kpad->extend_cfg) {  in adp5589_setup()
749 				     kpad->extend_cfg);  in adp5589_setup()
753 			    pdata->debounce_dis_mask & kpad->var->row_mask);  in adp5589_setup()
756 			     (pdata->debounce_dis_mask >> kpad->var->col_shift)  in adp5589_setup()
757 			     & kpad->var->col_mask);  in adp5589_setup()
759 	if (!kpad->is_adp5585)  in adp5589_setup()
766 			     (kpad->is_adp5585 ? 0 : LOGIC2_INT) |  in adp5589_setup()
768 			     (kpad->is_adp5585 ? 0 : LOCK_INT) |  in adp5589_setup()
784 static void adp5589_report_switch_state(struct adp5589_kpad *kpad)  in adp5589_report_switch_state()  argument
788 	int gpi_stat1 = adp5589_read(kpad->client,  in adp5589_report_switch_state()
789 				     kpad->var->reg(ADP5589_GPI_STATUS_A));  in adp5589_report_switch_state()
790 	int gpi_stat2 = adp5589_read(kpad->client,  in adp5589_report_switch_state()
791 				     kpad->var->reg(ADP5589_GPI_STATUS_B));  in adp5589_report_switch_state()
792 	int gpi_stat3 = !kpad->is_adp5585 ?  in adp5589_report_switch_state()
793 			adp5589_read(kpad->client, ADP5589_GPI_STATUS_C) : 0;  in adp5589_report_switch_state()
795 	for (i = 0; i < kpad->gpimapsize; i++) {  in adp5589_report_switch_state()
796 		unsigned short pin = kpad->gpimap[i].pin;  in adp5589_report_switch_state()
798 		if (pin <= kpad->var->gpi_pin_row_end) {  in adp5589_report_switch_state()
800 			pin_loc = pin - kpad->var->gpi_pin_row_base;  in adp5589_report_switch_state()
801 		} else if ((pin - kpad->var->gpi_pin_col_base) < 8) {  in adp5589_report_switch_state()
803 			pin_loc = pin - kpad->var->gpi_pin_col_base;  in adp5589_report_switch_state()
806 			pin_loc = pin - kpad->var->gpi_pin_col_base - 8;  in adp5589_report_switch_state()
810 			dev_err(&kpad->client->dev,  in adp5589_report_switch_state()
816 		input_report_switch(kpad->input,  in adp5589_report_switch_state()
817 				    kpad->gpimap[i].sw_evt,  in adp5589_report_switch_state()
821 	input_sync(kpad->input);  in adp5589_report_switch_state()
824 static int adp5589_keypad_add(struct adp5589_kpad *kpad, unsigned int revid)  in adp5589_keypad_add()  argument
826 	struct i2c_client *client = kpad->client;  in adp5589_keypad_add()
833 	if (!((pdata->keypad_en_mask & kpad->var->row_mask) &&  in adp5589_keypad_add()
834 			(pdata->keypad_en_mask >> kpad->var->col_shift)) ||  in adp5589_keypad_add()
840 	if (pdata->keymapsize != kpad->var->keymapsize) {  in adp5589_keypad_add()
850 	if (pdata->gpimapsize > kpad->var->gpimapsize_max) {  in adp5589_keypad_add()
858 		if (pin < kpad->var->gpi_pin_base ||  in adp5589_keypad_add()
859 				pin > kpad->var->gpi_pin_end) {  in adp5589_keypad_add()
864 		if (BIT(pin - kpad->var->gpi_pin_row_base) &  in adp5589_keypad_add()
880 	kpad->input = input;  in adp5589_keypad_add()
886 	input_set_drvdata(input, kpad);  in adp5589_keypad_add()
893 	input->keycodesize = sizeof(kpad->keycode[0]);  in adp5589_keypad_add()
895 	input->keycode = kpad->keycode;  in adp5589_keypad_add()
897 	memcpy(kpad->keycode, pdata->keymap,  in adp5589_keypad_add()
900 	kpad->gpimap = pdata->gpimap;  in adp5589_keypad_add()
901 	kpad->gpimapsize = pdata->gpimapsize;  in adp5589_keypad_add()
910 		if (kpad->keycode[i] <= KEY_MAX)  in adp5589_keypad_add()
911 			__set_bit(kpad->keycode[i], input->keybit);  in adp5589_keypad_add()
914 	if (kpad->gpimapsize)  in adp5589_keypad_add()
916 	for (i = 0; i < kpad->gpimapsize; i++)  in adp5589_keypad_add()
917 		__set_bit(kpad->gpimap[i].sw_evt, input->swbit);  in adp5589_keypad_add()
928 					  client->dev.driver->name, kpad);  in adp5589_keypad_add()
940 	struct adp5589_kpad *kpad = i2c_get_clientdata(client);  in adp5589_clear_config()  local
942 	adp5589_write(client, kpad->var->reg(ADP5589_GENERAL_CFG), 0);  in adp5589_clear_config()
948 	struct adp5589_kpad *kpad;  in adp5589_probe()  local
965 	kpad = devm_kzalloc(&client->dev, sizeof(*kpad), GFP_KERNEL);  in adp5589_probe()
966 	if (!kpad)  in adp5589_probe()
969 	kpad->client = client;  in adp5589_probe()
973 		kpad->support_row5 = true;  in adp5589_probe()
976 		kpad->is_adp5585 = true;  in adp5589_probe()
977 		kpad->var = &const_adp5585;  in adp5589_probe()
980 		kpad->support_row5 = true;  in adp5589_probe()
981 		kpad->var = &const_adp5589;  in adp5589_probe()
997 		error = adp5589_keypad_add(kpad, revid);  in adp5589_probe()
1002 	error = adp5589_setup(kpad);  in adp5589_probe()
1006 	if (kpad->gpimapsize)  in adp5589_probe()
1007 		adp5589_report_switch_state(kpad);  in adp5589_probe()
1009 	error = adp5589_gpio_add(kpad);  in adp5589_probe()
1013 	i2c_set_clientdata(client, kpad);  in adp5589_probe()
1022 	struct adp5589_kpad *kpad = i2c_get_clientdata(client);  in adp5589_suspend()  local
1024 	if (kpad->input)  in adp5589_suspend()
1033 	struct adp5589_kpad *kpad = i2c_get_clientdata(client);  in adp5589_resume()  local
1035 	if (kpad->input)  in adp5589_resume()