adp5520-keys.c 4.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193
  1. // SPDX-License-Identifier: GPL-2.0-or-later
  2. /*
  3. * Keypad driver for Analog Devices ADP5520 MFD PMICs
  4. *
  5. * Copyright 2009 Analog Devices Inc.
  6. */
  7. #include <linux/module.h>
  8. #include <linux/kernel.h>
  9. #include <linux/platform_device.h>
  10. #include <linux/input.h>
  11. #include <linux/mfd/adp5520.h>
  12. #include <linux/slab.h>
  13. #include <linux/device.h>
  14. struct adp5520_keys {
  15. struct input_dev *input;
  16. struct notifier_block notifier;
  17. struct device *master;
  18. unsigned short keycode[ADP5520_KEYMAPSIZE];
  19. };
  20. static void adp5520_keys_report_event(struct adp5520_keys *dev,
  21. unsigned short keymask, int value)
  22. {
  23. int i;
  24. for (i = 0; i < ADP5520_MAXKEYS; i++)
  25. if (keymask & (1 << i))
  26. input_report_key(dev->input, dev->keycode[i], value);
  27. input_sync(dev->input);
  28. }
  29. static int adp5520_keys_notifier(struct notifier_block *nb,
  30. unsigned long event, void *data)
  31. {
  32. struct adp5520_keys *dev;
  33. uint8_t reg_val_lo, reg_val_hi;
  34. unsigned short keymask;
  35. dev = container_of(nb, struct adp5520_keys, notifier);
  36. if (event & ADP5520_KP_INT) {
  37. adp5520_read(dev->master, ADP5520_KP_INT_STAT_1, &reg_val_lo);
  38. adp5520_read(dev->master, ADP5520_KP_INT_STAT_2, &reg_val_hi);
  39. keymask = (reg_val_hi << 8) | reg_val_lo;
  40. /* Read twice to clear */
  41. adp5520_read(dev->master, ADP5520_KP_INT_STAT_1, &reg_val_lo);
  42. adp5520_read(dev->master, ADP5520_KP_INT_STAT_2, &reg_val_hi);
  43. keymask |= (reg_val_hi << 8) | reg_val_lo;
  44. adp5520_keys_report_event(dev, keymask, 1);
  45. }
  46. if (event & ADP5520_KR_INT) {
  47. adp5520_read(dev->master, ADP5520_KR_INT_STAT_1, &reg_val_lo);
  48. adp5520_read(dev->master, ADP5520_KR_INT_STAT_2, &reg_val_hi);
  49. keymask = (reg_val_hi << 8) | reg_val_lo;
  50. /* Read twice to clear */
  51. adp5520_read(dev->master, ADP5520_KR_INT_STAT_1, &reg_val_lo);
  52. adp5520_read(dev->master, ADP5520_KR_INT_STAT_2, &reg_val_hi);
  53. keymask |= (reg_val_hi << 8) | reg_val_lo;
  54. adp5520_keys_report_event(dev, keymask, 0);
  55. }
  56. return 0;
  57. }
  58. static int adp5520_keys_probe(struct platform_device *pdev)
  59. {
  60. struct adp5520_keys_platform_data *pdata = dev_get_platdata(&pdev->dev);
  61. struct input_dev *input;
  62. struct adp5520_keys *dev;
  63. int ret, i;
  64. unsigned char en_mask, ctl_mask = 0;
  65. if (pdev->id != ID_ADP5520) {
  66. dev_err(&pdev->dev, "only ADP5520 supports Keypad\n");
  67. return -EINVAL;
  68. }
  69. if (!pdata) {
  70. dev_err(&pdev->dev, "missing platform data\n");
  71. return -EINVAL;
  72. }
  73. if (!(pdata->rows_en_mask && pdata->cols_en_mask))
  74. return -EINVAL;
  75. dev = devm_kzalloc(&pdev->dev, sizeof(*dev), GFP_KERNEL);
  76. if (!dev) {
  77. dev_err(&pdev->dev, "failed to alloc memory\n");
  78. return -ENOMEM;
  79. }
  80. input = devm_input_allocate_device(&pdev->dev);
  81. if (!input)
  82. return -ENOMEM;
  83. dev->master = pdev->dev.parent;
  84. dev->input = input;
  85. input->name = pdev->name;
  86. input->phys = "adp5520-keys/input0";
  87. input->dev.parent = &pdev->dev;
  88. input->id.bustype = BUS_I2C;
  89. input->id.vendor = 0x0001;
  90. input->id.product = 0x5520;
  91. input->id.version = 0x0001;
  92. input->keycodesize = sizeof(dev->keycode[0]);
  93. input->keycodemax = pdata->keymapsize;
  94. input->keycode = dev->keycode;
  95. memcpy(dev->keycode, pdata->keymap,
  96. pdata->keymapsize * input->keycodesize);
  97. /* setup input device */
  98. __set_bit(EV_KEY, input->evbit);
  99. if (pdata->repeat)
  100. __set_bit(EV_REP, input->evbit);
  101. for (i = 0; i < input->keycodemax; i++)
  102. __set_bit(dev->keycode[i], input->keybit);
  103. __clear_bit(KEY_RESERVED, input->keybit);
  104. ret = input_register_device(input);
  105. if (ret) {
  106. dev_err(&pdev->dev, "unable to register input device\n");
  107. return ret;
  108. }
  109. en_mask = pdata->rows_en_mask | pdata->cols_en_mask;
  110. ret = adp5520_set_bits(dev->master, ADP5520_GPIO_CFG_1, en_mask);
  111. if (en_mask & ADP5520_COL_C3)
  112. ctl_mask |= ADP5520_C3_MODE;
  113. if (en_mask & ADP5520_ROW_R3)
  114. ctl_mask |= ADP5520_R3_MODE;
  115. if (ctl_mask)
  116. ret |= adp5520_set_bits(dev->master, ADP5520_LED_CONTROL,
  117. ctl_mask);
  118. ret |= adp5520_set_bits(dev->master, ADP5520_GPIO_PULLUP,
  119. pdata->rows_en_mask);
  120. if (ret) {
  121. dev_err(&pdev->dev, "failed to write\n");
  122. return -EIO;
  123. }
  124. dev->notifier.notifier_call = adp5520_keys_notifier;
  125. ret = adp5520_register_notifier(dev->master, &dev->notifier,
  126. ADP5520_KP_IEN | ADP5520_KR_IEN);
  127. if (ret) {
  128. dev_err(&pdev->dev, "failed to register notifier\n");
  129. return ret;
  130. }
  131. platform_set_drvdata(pdev, dev);
  132. return 0;
  133. }
  134. static int adp5520_keys_remove(struct platform_device *pdev)
  135. {
  136. struct adp5520_keys *dev = platform_get_drvdata(pdev);
  137. adp5520_unregister_notifier(dev->master, &dev->notifier,
  138. ADP5520_KP_IEN | ADP5520_KR_IEN);
  139. return 0;
  140. }
  141. static struct platform_driver adp5520_keys_driver = {
  142. .driver = {
  143. .name = "adp5520-keys",
  144. },
  145. .probe = adp5520_keys_probe,
  146. .remove = adp5520_keys_remove,
  147. };
  148. module_platform_driver(adp5520_keys_driver);
  149. MODULE_AUTHOR("Michael Hennerich <hennerich@blackfin.uclinux.org>");
  150. MODULE_DESCRIPTION("Keys ADP5520 Driver");
  151. MODULE_LICENSE("GPL");
  152. MODULE_ALIAS("platform:adp5520-keys");