Lines Matching refs:kpad
390 struct adp5589_kpad *kpad = gpiochip_get_data(chip); in adp5589_gpio_get_value() local
391 unsigned int bank = kpad->var->bank(kpad->gpiomap[off]); in adp5589_gpio_get_value()
392 unsigned int bit = kpad->var->bit(kpad->gpiomap[off]); in adp5589_gpio_get_value()
394 return !!(adp5589_read(kpad->client, in adp5589_gpio_get_value()
395 kpad->var->reg(ADP5589_GPI_STATUS_A) + bank) & in adp5589_gpio_get_value()
402 struct adp5589_kpad *kpad = gpiochip_get_data(chip); in adp5589_gpio_set_value() local
403 unsigned int bank = kpad->var->bank(kpad->gpiomap[off]); in adp5589_gpio_set_value()
404 unsigned int bit = kpad->var->bit(kpad->gpiomap[off]); in adp5589_gpio_set_value()
406 mutex_lock(&kpad->gpio_lock); in adp5589_gpio_set_value()
409 kpad->dat_out[bank] |= bit; in adp5589_gpio_set_value()
411 kpad->dat_out[bank] &= ~bit; in adp5589_gpio_set_value()
413 adp5589_write(kpad->client, kpad->var->reg(ADP5589_GPO_DATA_OUT_A) + in adp5589_gpio_set_value()
414 bank, kpad->dat_out[bank]); in adp5589_gpio_set_value()
416 mutex_unlock(&kpad->gpio_lock); in adp5589_gpio_set_value()
421 struct adp5589_kpad *kpad = gpiochip_get_data(chip); in adp5589_gpio_direction_input() local
422 unsigned int bank = kpad->var->bank(kpad->gpiomap[off]); in adp5589_gpio_direction_input()
423 unsigned int bit = kpad->var->bit(kpad->gpiomap[off]); in adp5589_gpio_direction_input()
426 mutex_lock(&kpad->gpio_lock); in adp5589_gpio_direction_input()
428 kpad->dir[bank] &= ~bit; in adp5589_gpio_direction_input()
429 ret = adp5589_write(kpad->client, in adp5589_gpio_direction_input()
430 kpad->var->reg(ADP5589_GPIO_DIRECTION_A) + bank, in adp5589_gpio_direction_input()
431 kpad->dir[bank]); in adp5589_gpio_direction_input()
433 mutex_unlock(&kpad->gpio_lock); in adp5589_gpio_direction_input()
441 struct adp5589_kpad *kpad = gpiochip_get_data(chip); in adp5589_gpio_direction_output() local
442 unsigned int bank = kpad->var->bank(kpad->gpiomap[off]); in adp5589_gpio_direction_output()
443 unsigned int bit = kpad->var->bit(kpad->gpiomap[off]); in adp5589_gpio_direction_output()
446 mutex_lock(&kpad->gpio_lock); in adp5589_gpio_direction_output()
448 kpad->dir[bank] |= bit; in adp5589_gpio_direction_output()
451 kpad->dat_out[bank] |= bit; in adp5589_gpio_direction_output()
453 kpad->dat_out[bank] &= ~bit; in adp5589_gpio_direction_output()
455 ret = adp5589_write(kpad->client, kpad->var->reg(ADP5589_GPO_DATA_OUT_A) in adp5589_gpio_direction_output()
456 + bank, kpad->dat_out[bank]); in adp5589_gpio_direction_output()
457 ret |= adp5589_write(kpad->client, in adp5589_gpio_direction_output()
458 kpad->var->reg(ADP5589_GPIO_DIRECTION_A) + bank, in adp5589_gpio_direction_output()
459 kpad->dir[bank]); in adp5589_gpio_direction_output()
461 mutex_unlock(&kpad->gpio_lock); in adp5589_gpio_direction_output()
466 static int adp5589_build_gpiomap(struct adp5589_kpad *kpad, in adp5589_build_gpiomap() argument
475 for (i = 0; i < kpad->var->maxgpio; i++) in adp5589_build_gpiomap()
479 for (i = 0; i < kpad->gpimapsize; i++) in adp5589_build_gpiomap()
480 pin_used[kpad->gpimap[i].pin - kpad->var->gpi_pin_base] = true; in adp5589_build_gpiomap()
482 if (kpad->extend_cfg & R4_EXTEND_CFG) in adp5589_build_gpiomap()
485 if (kpad->extend_cfg & C4_EXTEND_CFG) in adp5589_build_gpiomap()
486 pin_used[kpad->var->c4_extend_cfg] = true; in adp5589_build_gpiomap()
488 if (!kpad->support_row5) in adp5589_build_gpiomap()
491 for (i = 0; i < kpad->var->maxgpio; i++) in adp5589_build_gpiomap()
493 kpad->gpiomap[n_unused++] = i; in adp5589_build_gpiomap()
498 static int adp5589_gpio_add(struct adp5589_kpad *kpad) in adp5589_gpio_add() argument
500 struct device *dev = &kpad->client->dev; in adp5589_gpio_add()
508 kpad->gc.parent = dev; in adp5589_gpio_add()
509 kpad->gc.ngpio = adp5589_build_gpiomap(kpad, pdata); in adp5589_gpio_add()
510 if (kpad->gc.ngpio == 0) { in adp5589_gpio_add()
515 kpad->export_gpio = true; in adp5589_gpio_add()
517 kpad->gc.direction_input = adp5589_gpio_direction_input; in adp5589_gpio_add()
518 kpad->gc.direction_output = adp5589_gpio_direction_output; in adp5589_gpio_add()
519 kpad->gc.get = adp5589_gpio_get_value; in adp5589_gpio_add()
520 kpad->gc.set = adp5589_gpio_set_value; in adp5589_gpio_add()
521 kpad->gc.can_sleep = 1; in adp5589_gpio_add()
523 kpad->gc.base = gpio_data->gpio_start; in adp5589_gpio_add()
524 kpad->gc.label = kpad->client->name; in adp5589_gpio_add()
525 kpad->gc.owner = THIS_MODULE; in adp5589_gpio_add()
527 mutex_init(&kpad->gpio_lock); in adp5589_gpio_add()
529 error = gpiochip_add_data(&kpad->gc, kpad); in adp5589_gpio_add()
535 for (i = 0; i <= kpad->var->bank(kpad->var->maxgpio); i++) { in adp5589_gpio_add()
536 kpad->dat_out[i] = adp5589_read(kpad->client, kpad->var->reg( in adp5589_gpio_add()
538 kpad->dir[i] = adp5589_read(kpad->client, kpad->var->reg( in adp5589_gpio_add()
543 error = gpio_data->setup(kpad->client, in adp5589_gpio_add()
544 kpad->gc.base, kpad->gc.ngpio, in adp5589_gpio_add()
553 static void adp5589_gpio_remove(struct adp5589_kpad *kpad) in adp5589_gpio_remove() argument
555 struct device *dev = &kpad->client->dev; in adp5589_gpio_remove()
560 if (!kpad->export_gpio) in adp5589_gpio_remove()
564 error = gpio_data->teardown(kpad->client, in adp5589_gpio_remove()
565 kpad->gc.base, kpad->gc.ngpio, in adp5589_gpio_remove()
571 gpiochip_remove(&kpad->gc); in adp5589_gpio_remove()
574 static inline int adp5589_gpio_add(struct adp5589_kpad *kpad) in adp5589_gpio_add() argument
579 static inline void adp5589_gpio_remove(struct adp5589_kpad *kpad) in adp5589_gpio_remove() argument
584 static void adp5589_report_switches(struct adp5589_kpad *kpad, in adp5589_report_switches() argument
589 for (i = 0; i < kpad->gpimapsize; i++) { in adp5589_report_switches()
590 if (key_val == kpad->gpimap[i].pin) { in adp5589_report_switches()
591 input_report_switch(kpad->input, in adp5589_report_switches()
592 kpad->gpimap[i].sw_evt, in adp5589_report_switches()
599 static void adp5589_report_events(struct adp5589_kpad *kpad, int ev_cnt) in adp5589_report_events() argument
604 int key = adp5589_read(kpad->client, ADP5589_5_FIFO_1 + i); in adp5589_report_events()
607 if (key_val >= kpad->var->gpi_pin_base && in adp5589_report_events()
608 key_val <= kpad->var->gpi_pin_end) { in adp5589_report_events()
609 adp5589_report_switches(kpad, key, key_val); in adp5589_report_events()
611 input_report_key(kpad->input, in adp5589_report_events()
612 kpad->keycode[key_val - 1], in adp5589_report_events()
620 struct adp5589_kpad *kpad = handle; in adp5589_irq() local
621 struct i2c_client *client = kpad->client; in adp5589_irq()
632 adp5589_report_events(kpad, ev_cnt); in adp5589_irq()
633 input_sync(kpad->input); in adp5589_irq()
642 static int adp5589_get_evcode(struct adp5589_kpad *kpad, unsigned short key) in adp5589_get_evcode() argument
646 for (i = 0; i < kpad->var->keymapsize; i++) in adp5589_get_evcode()
647 if (key == kpad->keycode[i]) in adp5589_get_evcode()
650 dev_err(&kpad->client->dev, "RESET/UNLOCK key not in keycode map\n"); in adp5589_get_evcode()
655 static int adp5589_setup(struct adp5589_kpad *kpad) in adp5589_setup() argument
657 struct i2c_client *client = kpad->client; in adp5589_setup()
660 u8 (*reg) (u8) = kpad->var->reg; in adp5589_setup()
666 pdata->keypad_en_mask & kpad->var->row_mask); in adp5589_setup()
668 (pdata->keypad_en_mask >> kpad->var->col_shift) & in adp5589_setup()
669 kpad->var->col_mask); in adp5589_setup()
671 if (!kpad->is_adp5585) in adp5589_setup()
675 if (!kpad->is_adp5585 && pdata->en_keylock) { in adp5589_setup()
691 if (pin <= kpad->var->gpi_pin_row_end) { in adp5589_setup()
692 evt_mode1 |= (1 << (pin - kpad->var->gpi_pin_row_base)); in adp5589_setup()
695 ((1 << (pin - kpad->var->gpi_pin_col_base)) & 0xFF); in adp5589_setup()
696 if (!kpad->is_adp5585) in adp5589_setup()
698 kpad->var->gpi_pin_col_base)) >> 8); in adp5589_setup()
707 if (!kpad->is_adp5585) in adp5589_setup()
717 for (i = 0; i <= kpad->var->max_row_num; i++) { in adp5589_setup()
730 if (i % 4 == 3 || i == kpad->var->max_row_num) { in adp5589_setup()
737 for (i = 0; i <= kpad->var->max_col_num; i++) { in adp5589_setup()
738 unsigned val = 0, bit = 1 << (i + kpad->var->col_shift); in adp5589_setup()
750 if (i % 4 == 3 || i == kpad->var->max_col_num) { in adp5589_setup()
760 adp5589_get_evcode(kpad, in adp5589_setup()
763 adp5589_get_evcode(kpad, in adp5589_setup()
766 adp5589_get_evcode(kpad, in adp5589_setup()
768 kpad->extend_cfg |= R4_EXTEND_CFG; in adp5589_setup()
773 adp5589_get_evcode(kpad, in adp5589_setup()
776 adp5589_get_evcode(kpad, in adp5589_setup()
778 kpad->extend_cfg |= C4_EXTEND_CFG; in adp5589_setup()
781 if (kpad->extend_cfg) { in adp5589_setup()
785 kpad->extend_cfg); in adp5589_setup()
789 pdata->debounce_dis_mask & kpad->var->row_mask); in adp5589_setup()
792 (pdata->debounce_dis_mask >> kpad->var->col_shift) in adp5589_setup()
793 & kpad->var->col_mask); in adp5589_setup()
795 if (!kpad->is_adp5585) in adp5589_setup()
802 (kpad->is_adp5585 ? 0 : LOGIC2_INT) | in adp5589_setup()
804 (kpad->is_adp5585 ? 0 : LOCK_INT) | in adp5589_setup()
820 static void adp5589_report_switch_state(struct adp5589_kpad *kpad) in adp5589_report_switch_state() argument
824 int gpi_stat1 = adp5589_read(kpad->client, in adp5589_report_switch_state()
825 kpad->var->reg(ADP5589_GPI_STATUS_A)); in adp5589_report_switch_state()
826 int gpi_stat2 = adp5589_read(kpad->client, in adp5589_report_switch_state()
827 kpad->var->reg(ADP5589_GPI_STATUS_B)); in adp5589_report_switch_state()
828 int gpi_stat3 = !kpad->is_adp5585 ? in adp5589_report_switch_state()
829 adp5589_read(kpad->client, ADP5589_GPI_STATUS_C) : 0; in adp5589_report_switch_state()
831 for (i = 0; i < kpad->gpimapsize; i++) { in adp5589_report_switch_state()
832 unsigned short pin = kpad->gpimap[i].pin; in adp5589_report_switch_state()
834 if (pin <= kpad->var->gpi_pin_row_end) { in adp5589_report_switch_state()
836 pin_loc = pin - kpad->var->gpi_pin_row_base; in adp5589_report_switch_state()
837 } else if ((pin - kpad->var->gpi_pin_col_base) < 8) { in adp5589_report_switch_state()
839 pin_loc = pin - kpad->var->gpi_pin_col_base; in adp5589_report_switch_state()
842 pin_loc = pin - kpad->var->gpi_pin_col_base - 8; in adp5589_report_switch_state()
846 dev_err(&kpad->client->dev, in adp5589_report_switch_state()
852 input_report_switch(kpad->input, in adp5589_report_switch_state()
853 kpad->gpimap[i].sw_evt, in adp5589_report_switch_state()
857 input_sync(kpad->input); in adp5589_report_switch_state()
860 static int adp5589_keypad_add(struct adp5589_kpad *kpad, unsigned int revid) in adp5589_keypad_add() argument
862 struct i2c_client *client = kpad->client; in adp5589_keypad_add()
869 if (!((pdata->keypad_en_mask & kpad->var->row_mask) && in adp5589_keypad_add()
870 (pdata->keypad_en_mask >> kpad->var->col_shift)) || in adp5589_keypad_add()
876 if (pdata->keymapsize != kpad->var->keymapsize) { in adp5589_keypad_add()
886 if (pdata->gpimapsize > kpad->var->gpimapsize_max) { in adp5589_keypad_add()
894 if (pin < kpad->var->gpi_pin_base || in adp5589_keypad_add()
895 pin > kpad->var->gpi_pin_end) { in adp5589_keypad_add()
900 if ((1 << (pin - kpad->var->gpi_pin_row_base)) & in adp5589_keypad_add()
916 kpad->input = input; in adp5589_keypad_add()
922 input_set_drvdata(input, kpad); in adp5589_keypad_add()
929 input->keycodesize = sizeof(kpad->keycode[0]); in adp5589_keypad_add()
931 input->keycode = kpad->keycode; in adp5589_keypad_add()
933 memcpy(kpad->keycode, pdata->keymap, in adp5589_keypad_add()
936 kpad->gpimap = pdata->gpimap; in adp5589_keypad_add()
937 kpad->gpimapsize = pdata->gpimapsize; in adp5589_keypad_add()
946 if (kpad->keycode[i] <= KEY_MAX) in adp5589_keypad_add()
947 __set_bit(kpad->keycode[i], input->keybit); in adp5589_keypad_add()
950 if (kpad->gpimapsize) in adp5589_keypad_add()
952 for (i = 0; i < kpad->gpimapsize; i++) in adp5589_keypad_add()
953 __set_bit(kpad->gpimap[i].sw_evt, input->swbit); in adp5589_keypad_add()
963 client->dev.driver->name, kpad); in adp5589_keypad_add()
982 static void adp5589_keypad_remove(struct adp5589_kpad *kpad) in adp5589_keypad_remove() argument
984 if (kpad->input) { in adp5589_keypad_remove()
985 free_irq(kpad->client->irq, kpad); in adp5589_keypad_remove()
986 input_unregister_device(kpad->input); in adp5589_keypad_remove()
993 struct adp5589_kpad *kpad; in adp5589_probe() local
1010 kpad = kzalloc(sizeof(*kpad), GFP_KERNEL); in adp5589_probe()
1011 if (!kpad) in adp5589_probe()
1014 kpad->client = client; in adp5589_probe()
1018 kpad->support_row5 = true; in adp5589_probe()
1021 kpad->is_adp5585 = true; in adp5589_probe()
1022 kpad->var = &const_adp5585; in adp5589_probe()
1025 kpad->support_row5 = true; in adp5589_probe()
1026 kpad->var = &const_adp5589; in adp5589_probe()
1039 error = adp5589_keypad_add(kpad, revid); in adp5589_probe()
1044 error = adp5589_setup(kpad); in adp5589_probe()
1048 if (kpad->gpimapsize) in adp5589_probe()
1049 adp5589_report_switch_state(kpad); in adp5589_probe()
1051 error = adp5589_gpio_add(kpad); in adp5589_probe()
1055 i2c_set_clientdata(client, kpad); in adp5589_probe()
1061 adp5589_keypad_remove(kpad); in adp5589_probe()
1063 kfree(kpad); in adp5589_probe()
1070 struct adp5589_kpad *kpad = i2c_get_clientdata(client); in adp5589_remove() local
1072 adp5589_write(client, kpad->var->reg(ADP5589_GENERAL_CFG), 0); in adp5589_remove()
1073 adp5589_keypad_remove(kpad); in adp5589_remove()
1074 adp5589_gpio_remove(kpad); in adp5589_remove()
1075 kfree(kpad); in adp5589_remove()
1083 struct adp5589_kpad *kpad = dev_get_drvdata(dev); in adp5589_suspend() local
1084 struct i2c_client *client = kpad->client; in adp5589_suspend()
1086 if (!kpad->input) in adp5589_suspend()
1099 struct adp5589_kpad *kpad = dev_get_drvdata(dev); in adp5589_resume() local
1100 struct i2c_client *client = kpad->client; in adp5589_resume()
1102 if (!kpad->input) in adp5589_resume()