UdfpsHandler.cpp 4.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188
  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 <display/drm/mi_disp.h>
  14. #include "UdfpsHandler.h"
  15. #include "xiaomi_touch.h"
  16. #define COMMAND_NIT 10
  17. #define PARAM_NIT_FOD 1
  18. #define PARAM_NIT_NONE 0
  19. #define COMMAND_FOD_PRESS_STATUS 1
  20. #define PARAM_FOD_PRESSED 1
  21. #define PARAM_FOD_RELEASED 0
  22. #define FOD_STATUS_OFF 0
  23. #define FOD_STATUS_ON 1
  24. #define TOUCH_DEV_PATH "/dev/xiaomi-touch"
  25. #define TOUCH_ID 0
  26. #define TOUCH_MAGIC 'T'
  27. #define TOUCH_IOC_SET_CUR_VALUE _IO(TOUCH_MAGIC, SET_CUR_VALUE)
  28. #define TOUCH_IOC_GET_CUR_VALUE _IO(TOUCH_MAGIC, GET_CUR_VALUE)
  29. #define DISP_FEATURE_PATH "/dev/mi_display/disp_feature"
  30. #define FOD_PRESS_STATUS_PATH "/sys/class/touch/touch_dev/fod_press_status"
  31. namespace {
  32. static bool readBool(int fd) {
  33. char c;
  34. int rc;
  35. rc = lseek(fd, 0, SEEK_SET);
  36. if (rc) {
  37. LOG(ERROR) << "failed to seek fd, err: " << rc;
  38. return false;
  39. }
  40. rc = read(fd, &c, sizeof(char));
  41. if (rc != 1) {
  42. LOG(ERROR) << "failed to read bool from fd, err: " << rc;
  43. return false;
  44. }
  45. return c != '0';
  46. }
  47. } // anonymous namespace
  48. class XiaomiSm8450UdfpsHander : public UdfpsHandler {
  49. public:
  50. void init(fingerprint_device_t* device) {
  51. mDevice = device;
  52. touch_fd_ = android::base::unique_fd(open(TOUCH_DEV_PATH, O_RDWR));
  53. disp_fd_ = android::base::unique_fd(open(DISP_FEATURE_PATH, O_RDWR));
  54. std::thread([this]() {
  55. int fd = open(FOD_PRESS_STATUS_PATH, O_RDONLY);
  56. if (fd < 0) {
  57. LOG(ERROR) << "failed to open fd, err: " << fd;
  58. return;
  59. }
  60. struct pollfd fodPressStatusPoll = {
  61. .fd = fd,
  62. .events = POLLERR | POLLPRI,
  63. .revents = 0,
  64. };
  65. while (true) {
  66. int rc = poll(&fodPressStatusPoll, 1, -1);
  67. if (rc < 0) {
  68. LOG(ERROR) << "failed to poll fd, err: " << rc;
  69. continue;
  70. }
  71. mDevice->extCmd(mDevice, COMMAND_FOD_PRESS_STATUS,
  72. readBool(fd) ? PARAM_FOD_PRESSED : PARAM_FOD_RELEASED);
  73. }
  74. }).detach();
  75. }
  76. void onFingerDown(uint32_t /*x*/, uint32_t /*y*/, float /*minor*/, float /*major*/) {
  77. LOG(INFO) << __func__;
  78. setFingerDown(true);
  79. }
  80. void onFingerUp() {
  81. LOG(INFO) << __func__;
  82. setFingerDown(false);
  83. }
  84. void onAcquired(int32_t result, int32_t vendorCode) {
  85. LOG(INFO) << __func__ << " result: " << result << " vendorCode: " << vendorCode;
  86. if (result == FINGERPRINT_ACQUIRED_GOOD) {
  87. setFingerDown(false);
  88. if (!enrolling) {
  89. setFodStatus(FOD_STATUS_OFF);
  90. }
  91. } else if (vendorCode == 21 || vendorCode == 23) {
  92. /*
  93. * vendorCode = 21 waiting for fingerprint authentication
  94. * vendorCode = 23 waiting for fingerprint enroll
  95. */
  96. setFodStatus(FOD_STATUS_ON);
  97. }
  98. }
  99. void cancel() {
  100. LOG(INFO) << __func__;
  101. enrolling = false;
  102. setFingerDown(false);
  103. setFodStatus(FOD_STATUS_OFF);
  104. }
  105. void preEnroll() {
  106. LOG(INFO) << __func__;
  107. enrolling = true;
  108. }
  109. void enroll() {
  110. LOG(INFO) << __func__;
  111. enrolling = true;
  112. }
  113. void postEnroll() {
  114. LOG(INFO) << __func__;
  115. enrolling = false;
  116. setFodStatus(FOD_STATUS_OFF);
  117. }
  118. private:
  119. fingerprint_device_t* mDevice;
  120. android::base::unique_fd touch_fd_;
  121. android::base::unique_fd disp_fd_;
  122. bool enrolling = false;
  123. void setFodStatus(int value) {
  124. int buf[MAX_BUF_SIZE] = {TOUCH_ID, Touch_Fod_Enable, value};
  125. ioctl(touch_fd_.get(), TOUCH_IOC_SET_CUR_VALUE, &buf);
  126. }
  127. void setFingerDown(bool pressed) {
  128. mDevice->extCmd(mDevice, COMMAND_NIT, pressed ? PARAM_NIT_FOD : PARAM_NIT_NONE);
  129. int buf[MAX_BUF_SIZE] = {TOUCH_ID, THP_FOD_DOWNUP_CTL, pressed ? 1 : 0};
  130. ioctl(touch_fd_.get(), TOUCH_IOC_SET_CUR_VALUE, &buf);
  131. // Request HBM
  132. disp_local_hbm_req req;
  133. req.base.flag = 0;
  134. req.base.disp_id = MI_DISP_PRIMARY;
  135. req.local_hbm_value = pressed ? LHBM_TARGET_BRIGHTNESS_WHITE_1000NIT
  136. : LHBM_TARGET_BRIGHTNESS_OFF_FINGER_UP;
  137. ioctl(disp_fd_.get(), MI_DISP_IOCTL_SET_LOCAL_HBM, &req);
  138. }
  139. };
  140. static UdfpsHandler* create() {
  141. return new XiaomiSm8450UdfpsHander();
  142. }
  143. static void destroy(UdfpsHandler* handler) {
  144. delete handler;
  145. }
  146. extern "C" UdfpsHandlerFactory UDFPS_HANDLER_FACTORY = {
  147. .create = create,
  148. .destroy = destroy,
  149. };