android_device_xiaomi_sm725.../udfps/UdfpsHandler.cpp
Sebastiano Barezzi f52759c8e1 sm7250-common: Implement UDFPS handler
Change-Id: I7afff305140639d38ebb8bc51fbe790a1636db9e
2022-06-05 14:29:13 +02:00

106 lines
2.4 KiB
C++

/*
* Copyright (C) 2022 The LineageOS Project
*
* SPDX-License-Identifier: Apache-2.0
*/
#define LOG_TAG "UdfpsHander.xiaomi_lito"
#include "UdfpsHandler.h"
#include <android-base/logging.h>
#include <fcntl.h>
#include <poll.h>
#include <thread>
#include <unistd.h>
#define COMMAND_NIT 10
#define PARAM_NIT_FOD 1
#define PARAM_NIT_NONE 0
static const char* kFodUiPaths[] = {
"/sys/devices/platform/soc/soc:qcom,dsi-display-primary/fod_ui",
"/sys/devices/platform/soc/soc:qcom,dsi-display/fod_ui",
};
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';
}
class XiaomiLitoUdfpsHander : public UdfpsHandler {
public:
void init(fingerprint_device_t *device) {
mDevice = device;
std::thread([this]() {
int fd;
for (auto& path : kFodUiPaths) {
fd = open(path, O_RDONLY);
if (fd >= 0) {
break;
}
}
if (fd < 0) {
LOG(ERROR) << "failed to open fd, err: " << fd;
return;
}
struct pollfd fodUiPoll = {
.fd = fd,
.events = POLLERR | POLLPRI,
.revents = 0,
};
while (true) {
int rc = poll(&fodUiPoll, 1, -1);
if (rc < 0) {
LOG(ERROR) << "failed to poll fd, err: " << rc;
continue;
}
mDevice->extCmd(mDevice, COMMAND_NIT,
readBool(fd) ? PARAM_NIT_FOD : PARAM_NIT_NONE);
}
}).detach();
}
void onFingerDown(uint32_t /*x*/, uint32_t /*y*/, float /*minor*/, float /*major*/) {
// nothing
}
void onFingerUp() {
// nothing
}
private:
fingerprint_device_t *mDevice;
};
static UdfpsHandler* create() {
return new XiaomiLitoUdfpsHander();
}
static void destroy(UdfpsHandler* handler) {
delete handler;
}
extern "C" UdfpsHandlerFactory UDFPS_HANDLER_FACTORY = {
.create = create,
.destroy = destroy,
};