UdfpsHandler.cpp 4.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167
  1. /*
  2. * Copyright (C) 2022 The LineageOS Project
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. */
  6. #define LOG_TAG "UdfpsHandler.xiaomi_sm8450"
  7. #include <android-base/logging.h>
  8. #include <android-base/unique_fd.h>
  9. #include <poll.h>
  10. #include <sys/ioctl.h>
  11. #include <fstream>
  12. #include <thread>
  13. #include "UdfpsHandler.h"
  14. #include "xiaomi_touch.h"
  15. #define COMMAND_NIT 10
  16. #define PARAM_NIT_FOD 1
  17. #define PARAM_NIT_NONE 0
  18. #define COMMAND_FOD_PRESS_STATUS 1
  19. #define PARAM_FOD_PRESSED 1
  20. #define PARAM_FOD_RELEASED 0
  21. #define FOD_STATUS_OFF 0
  22. #define FOD_STATUS_ON 1
  23. #define TOUCH_DEV_PATH "/dev/xiaomi-touch"
  24. #define TOUCH_ID 0
  25. #define TOUCH_MAGIC 'T'
  26. #define TOUCH_IOC_SET_CUR_VALUE _IO(TOUCH_MAGIC, SET_CUR_VALUE)
  27. #define TOUCH_IOC_GET_CUR_VALUE _IO(TOUCH_MAGIC, GET_CUR_VALUE)
  28. #define DISP_PARAM_PATH "sys/devices/virtual/mi_display/disp_feature/disp-DSI-0/disp_param"
  29. #define DISP_PARAM_LOCAL_HBM_MODE "9"
  30. #define DISP_PARAM_LOCAL_HBM_OFF "0"
  31. #define DISP_PARAM_LOCAL_HBM_ON "1"
  32. #define FOD_PRESS_STATUS_PATH "/sys/class/touch/touch_dev/fod_press_status"
  33. namespace {
  34. template <typename T>
  35. static void set(const std::string& path, const T& value) {
  36. std::ofstream file(path);
  37. file << value;
  38. }
  39. static bool readBool(int fd) {
  40. char c;
  41. int rc;
  42. rc = lseek(fd, 0, SEEK_SET);
  43. if (rc) {
  44. LOG(ERROR) << "failed to seek fd, err: " << rc;
  45. return false;
  46. }
  47. rc = read(fd, &c, sizeof(char));
  48. if (rc != 1) {
  49. LOG(ERROR) << "failed to read bool from fd, err: " << rc;
  50. return false;
  51. }
  52. return c != '0';
  53. }
  54. } // anonymous namespace
  55. class XiaomiSm8450UdfpsHander : public UdfpsHandler {
  56. public:
  57. void init(fingerprint_device_t* device) {
  58. mDevice = device;
  59. touch_fd_ = android::base::unique_fd(open(TOUCH_DEV_PATH, O_RDWR));
  60. std::thread([this]() {
  61. int fd = open(FOD_PRESS_STATUS_PATH, O_RDONLY);
  62. if (fd < 0) {
  63. LOG(ERROR) << "failed to open fd, err: " << fd;
  64. return;
  65. }
  66. struct pollfd fodPressStatusPoll = {
  67. .fd = fd,
  68. .events = POLLERR | POLLPRI,
  69. .revents = 0,
  70. };
  71. while (true) {
  72. int rc = poll(&fodPressStatusPoll, 1, -1);
  73. if (rc < 0) {
  74. LOG(ERROR) << "failed to poll fd, err: " << rc;
  75. continue;
  76. }
  77. mDevice->extCmd(mDevice, COMMAND_FOD_PRESS_STATUS,
  78. readBool(fd) ? PARAM_FOD_PRESSED : PARAM_FOD_RELEASED);
  79. }
  80. }).detach();
  81. }
  82. void onFingerDown(uint32_t /*x*/, uint32_t /*y*/, float /*minor*/, float /*major*/) {
  83. LOG(INFO) << __func__;
  84. setFingerDown(true);
  85. }
  86. void onFingerUp() {
  87. LOG(INFO) << __func__;
  88. setFingerDown(false);
  89. }
  90. void onAcquired(int32_t result, int32_t vendorCode) {
  91. LOG(INFO) << __func__ << " result: " << result << " vendorCode: " << vendorCode;
  92. if (result == FINGERPRINT_ACQUIRED_GOOD) {
  93. setFingerDown(false);
  94. setFodStatus(FOD_STATUS_OFF);
  95. } else if (vendorCode == 21 || vendorCode == 23) {
  96. /*
  97. * vendorCode = 21 waiting for fingerprint authentication
  98. * vendorCode = 23 waiting for fingerprint enroll
  99. */
  100. setFodStatus(FOD_STATUS_ON);
  101. }
  102. }
  103. void cancel() {
  104. LOG(INFO) << __func__;
  105. setFingerDown(false);
  106. setFodStatus(FOD_STATUS_OFF);
  107. }
  108. private:
  109. fingerprint_device_t* mDevice;
  110. android::base::unique_fd touch_fd_;
  111. void setFodStatus(int value) {
  112. int buf[MAX_BUF_SIZE] = {TOUCH_ID, Touch_Fod_Enable, value};
  113. ioctl(touch_fd_.get(), TOUCH_IOC_SET_CUR_VALUE, &buf);
  114. }
  115. void setFingerDown(bool pressed) {
  116. mDevice->extCmd(mDevice, COMMAND_NIT, pressed ? PARAM_NIT_FOD : PARAM_NIT_NONE);
  117. int buf[MAX_BUF_SIZE] = {TOUCH_ID, THP_FOD_DOWNUP_CTL, pressed ? 1 : 0};
  118. ioctl(touch_fd_.get(), TOUCH_IOC_SET_CUR_VALUE, &buf);
  119. set(DISP_PARAM_PATH,
  120. std::string(DISP_PARAM_LOCAL_HBM_MODE) + " " +
  121. (pressed ? DISP_PARAM_LOCAL_HBM_ON : DISP_PARAM_LOCAL_HBM_OFF));
  122. }
  123. };
  124. static UdfpsHandler* create() {
  125. return new XiaomiSm8450UdfpsHander();
  126. }
  127. static void destroy(UdfpsHandler* handler) {
  128. delete handler;
  129. }
  130. extern "C" UdfpsHandlerFactory UDFPS_HANDLER_FACTORY = {
  131. .create = create,
  132. .destroy = destroy,
  133. };