123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167 |
- /*
- * Copyright (C) 2022 The LineageOS Project
- *
- * SPDX-License-Identifier: Apache-2.0
- */
- #define LOG_TAG "UdfpsHandler.xiaomi_sm8450"
- #include <android-base/logging.h>
- #include <android-base/unique_fd.h>
- #include <poll.h>
- #include <sys/ioctl.h>
- #include <fstream>
- #include <thread>
- #include "UdfpsHandler.h"
- #include "xiaomi_touch.h"
- #define COMMAND_NIT 10
- #define PARAM_NIT_FOD 1
- #define PARAM_NIT_NONE 0
- #define COMMAND_FOD_PRESS_STATUS 1
- #define PARAM_FOD_PRESSED 1
- #define PARAM_FOD_RELEASED 0
- #define FOD_STATUS_OFF 0
- #define FOD_STATUS_ON 1
- #define TOUCH_DEV_PATH "/dev/xiaomi-touch"
- #define TOUCH_ID 0
- #define TOUCH_MAGIC 'T'
- #define TOUCH_IOC_SET_CUR_VALUE _IO(TOUCH_MAGIC, SET_CUR_VALUE)
- #define TOUCH_IOC_GET_CUR_VALUE _IO(TOUCH_MAGIC, GET_CUR_VALUE)
- #define DISP_PARAM_PATH "sys/devices/virtual/mi_display/disp_feature/disp-DSI-0/disp_param"
- #define DISP_PARAM_LOCAL_HBM_MODE "9"
- #define DISP_PARAM_LOCAL_HBM_OFF "0"
- #define DISP_PARAM_LOCAL_HBM_ON "1"
- #define FOD_PRESS_STATUS_PATH "/sys/class/touch/touch_dev/fod_press_status"
- namespace {
- template <typename T>
- static void set(const std::string& path, const T& value) {
- std::ofstream file(path);
- file << value;
- }
- static bool readBool(int fd) {
- char c;
- int rc;
- rc = lseek(fd, 0, SEEK_SET);
- if (rc) {
- LOG(ERROR) << "failed to seek fd, err: " << rc;
- return false;
- }
- rc = read(fd, &c, sizeof(char));
- if (rc != 1) {
- LOG(ERROR) << "failed to read bool from fd, err: " << rc;
- return false;
- }
- return c != '0';
- }
- } // anonymous namespace
- class XiaomiSm8450UdfpsHander : public UdfpsHandler {
- public:
- void init(fingerprint_device_t* device) {
- mDevice = device;
- touch_fd_ = android::base::unique_fd(open(TOUCH_DEV_PATH, O_RDWR));
- std::thread([this]() {
- int fd = open(FOD_PRESS_STATUS_PATH, O_RDONLY);
- if (fd < 0) {
- LOG(ERROR) << "failed to open fd, err: " << fd;
- return;
- }
- struct pollfd fodPressStatusPoll = {
- .fd = fd,
- .events = POLLERR | POLLPRI,
- .revents = 0,
- };
- while (true) {
- int rc = poll(&fodPressStatusPoll, 1, -1);
- if (rc < 0) {
- LOG(ERROR) << "failed to poll fd, err: " << rc;
- continue;
- }
- mDevice->extCmd(mDevice, COMMAND_FOD_PRESS_STATUS,
- readBool(fd) ? PARAM_FOD_PRESSED : PARAM_FOD_RELEASED);
- }
- }).detach();
- }
- void onFingerDown(uint32_t /*x*/, uint32_t /*y*/, float /*minor*/, float /*major*/) {
- LOG(INFO) << __func__;
- setFingerDown(true);
- }
- void onFingerUp() {
- LOG(INFO) << __func__;
- setFingerDown(false);
- }
- void onAcquired(int32_t result, int32_t vendorCode) {
- LOG(INFO) << __func__ << " result: " << result << " vendorCode: " << vendorCode;
- if (result == FINGERPRINT_ACQUIRED_GOOD) {
- setFingerDown(false);
- setFodStatus(FOD_STATUS_OFF);
- } else if (vendorCode == 21 || vendorCode == 23) {
- /*
- * vendorCode = 21 waiting for fingerprint authentication
- * vendorCode = 23 waiting for fingerprint enroll
- */
- setFodStatus(FOD_STATUS_ON);
- }
- }
- void cancel() {
- LOG(INFO) << __func__;
- setFingerDown(false);
- setFodStatus(FOD_STATUS_OFF);
- }
- private:
- fingerprint_device_t* mDevice;
- android::base::unique_fd touch_fd_;
- void setFodStatus(int value) {
- int buf[MAX_BUF_SIZE] = {TOUCH_ID, Touch_Fod_Enable, value};
- ioctl(touch_fd_.get(), TOUCH_IOC_SET_CUR_VALUE, &buf);
- }
- void setFingerDown(bool pressed) {
- mDevice->extCmd(mDevice, COMMAND_NIT, pressed ? PARAM_NIT_FOD : PARAM_NIT_NONE);
- int buf[MAX_BUF_SIZE] = {TOUCH_ID, THP_FOD_DOWNUP_CTL, pressed ? 1 : 0};
- ioctl(touch_fd_.get(), TOUCH_IOC_SET_CUR_VALUE, &buf);
- set(DISP_PARAM_PATH,
- std::string(DISP_PARAM_LOCAL_HBM_MODE) + " " +
- (pressed ? DISP_PARAM_LOCAL_HBM_ON : DISP_PARAM_LOCAL_HBM_OFF));
- }
- };
- static UdfpsHandler* create() {
- return new XiaomiSm8450UdfpsHander();
- }
- static void destroy(UdfpsHandler* handler) {
- delete handler;
- }
- extern "C" UdfpsHandlerFactory UDFPS_HANDLER_FACTORY = {
- .create = create,
- .destroy = destroy,
- };
|