From 6261647b3f21363009df563b4bfa2470d3516940 Mon Sep 17 00:00:00 2001
From: Cosmin Tanislav <demonsingur@gmail.com>
Date: Sun, 20 Feb 2022 19:21:09 +0200
Subject: [PATCH] sm7125-common: sensors: Implement UDFPS sensor

Change-Id: I8b65e3196a7d6f158f4ff589b9755cf7c7e51c92
---
 .../frameworks/base/core/res/res/values/config.xml    |  2 ++
 rootdir/etc/init.samsung.rc                           |  1 +
 sensors/Sensor.h                                      | 11 +++++++++++
 sensors/SensorsSubHal.cpp                             |  4 +++-
 sepolicy/vendor/hal_sensors_default.te                |  2 ++
 5 files changed, 19 insertions(+), 1 deletion(-)

diff --git a/overlay/frameworks/base/core/res/res/values/config.xml b/overlay/frameworks/base/core/res/res/values/config.xml
index f1068b9..10afa0b 100644
--- a/overlay/frameworks/base/core/res/res/values/config.xml
+++ b/overlay/frameworks/base/core/res/res/values/config.xml
@@ -1228,4 +1228,6 @@
     <!-- The type of the light sensor to be used by the display framework for things like
          auto-brightness. If unset, then it just gets the default sensor of type TYPE_LIGHT. -->
     <string name="config_displayLightSensorType">com.samsung.sensor.physical_light</string>
+    <!-- Type of the udfps long press sensor. Empty if long press is not supported. -->
+    <string name="config_dozeUdfpsLongPressSensorType" translatable="false">org.lineageos.sensor.udfps</string>
 </resources>
diff --git a/rootdir/etc/init.samsung.rc b/rootdir/etc/init.samsung.rc
index cb517c3..c59bd79 100644
--- a/rootdir/etc/init.samsung.rc
+++ b/rootdir/etc/init.samsung.rc
@@ -167,6 +167,7 @@ on boot
     chmod 0660 /sys/class/sec/tsp/input/enabled
     chown system system /sys/class/sec/tsp/enabled
     chmod 0660 /sys/class/sec/tsp/enabled
+    chown system system /sys/class/sec/tsp/input/fod_pressed
     chown root system /proc/tsp_msg
     chmod 0440 /proc/tsp_msg
     chown system radio /sys/class/sec/tsp/pressure_enable
diff --git a/sensors/Sensor.h b/sensors/Sensor.h
index 605e8e1..0b0f53c 100644
--- a/sensors/Sensor.h
+++ b/sensors/Sensor.h
@@ -115,6 +115,17 @@ class SysfsPollingOneShotSensor : public OneShotSensor {
     int mPollFd;
 };
 
+const std::string kTsUdfpsPressedPath = "/sys/class/sec/tsp/input/fod_pressed";
+
+class UdfpsSensor : public SysfsPollingOneShotSensor {
+  public:
+    UdfpsSensor(int32_t sensorHandle, ISensorsEventCallback* callback)
+        : SysfsPollingOneShotSensor(
+              sensorHandle, callback, kTsUdfpsPressedPath,
+              "UDFPS Sensor", "org.lineageos.sensor.udfps",
+              static_cast<SensorType>(static_cast<int32_t>(SensorType::DEVICE_PRIVATE_BASE) + 2)) {}
+};
+
 }  // namespace implementation
 }  // namespace subhal
 }  // namespace V2_1
diff --git a/sensors/SensorsSubHal.cpp b/sensors/SensorsSubHal.cpp
index 6cbcb56..9306b98 100644
--- a/sensors/SensorsSubHal.cpp
+++ b/sensors/SensorsSubHal.cpp
@@ -32,7 +32,9 @@ namespace implementation {
 using ::android::hardware::Void;
 using ::android::hardware::sensors::V2_0::implementation::ScopedWakelock;
 
-SensorsSubHal::SensorsSubHal() : mCallback(nullptr), mNextHandle(1) {}
+SensorsSubHal::SensorsSubHal() : mCallback(nullptr), mNextHandle(1) {
+    AddSensor<UdfpsSensor>();
+}
 
 Return<void> SensorsSubHal::getSensorsList_2_1(ISensors::getSensorsList_2_1_cb _hidl_cb) {
     std::vector<SensorInfo> sensors;
diff --git a/sepolicy/vendor/hal_sensors_default.te b/sepolicy/vendor/hal_sensors_default.te
index e9a587c..4f866e6 100644
--- a/sepolicy/vendor/hal_sensors_default.te
+++ b/sepolicy/vendor/hal_sensors_default.te
@@ -34,6 +34,8 @@ allow hal_sensors_default sysfs_sec_key:file r_file_perms;
 allow hal_sensors_default sysfs_sec_touchscreen:dir r_dir_perms;
 allow hal_sensors_default sysfs_sec_touchscreen:file r_file_perms;
 allow hal_sensors_default sysfs_sec_touchscreen:lnk_file r_file_perms;
+allow hal_sensors_default sysfs_power_writable:dir search;
+allow hal_sensors_default sysfs_power_writable:file { read open };
 
 # /sys/class/sec/tsp/cmd
 allow hal_sensors_default sysfs_touchscreen_writable:file rw_file_perms;