From ba5cfd5c43206af82a5ed11fb9e61cecb40a6af9 Mon Sep 17 00:00:00 2001
From: Cosmin Tanislav <demonsingur@gmail.com>
Date: Sat, 14 Jan 2023 01:13:46 +0200
Subject: [PATCH] Revert "eqs: disable aod"

This reverts commit 373ed4b1b76301cf4a3a02be9b71594f89edd29b.
---
 .../eqs/Frameworks/res/values/config.xml      |  2 +-
 sensors/Sensor.cpp                            | 41 +++++++++++++++++--
 sensors/Sensor.h                              |  7 +++-
 3 files changed, 44 insertions(+), 6 deletions(-)

diff --git a/resource-overlay/eqs/Frameworks/res/values/config.xml b/resource-overlay/eqs/Frameworks/res/values/config.xml
index b7fafeb..87835ea 100644
--- a/resource-overlay/eqs/Frameworks/res/values/config.xml
+++ b/resource-overlay/eqs/Frameworks/res/values/config.xml
@@ -229,7 +229,7 @@
     <!-- Whether the always on display mode is available. This should only be enabled
          on devices where the display has been tuned to be power efficient in DOZE and/or
          DOZE_SUSPEND states. -->
-    <bool name="config_dozeAlwaysOnDisplayAvailable">false</bool>
+    <bool name="config_dozeAlwaysOnDisplayAvailable">true</bool>
 
     <!-- Control whether the always on display mode is enabled by default. This value will be used
          during initialization when the setting is still null. -->
diff --git a/sensors/Sensor.cpp b/sensors/Sensor.cpp
index 0df0108..0b1a152 100644
--- a/sensors/Sensor.cpp
+++ b/sensors/Sensor.cpp
@@ -20,7 +20,6 @@
 #include <log/log.h>
 #include <utils/SystemClock.h>
 
-#include <chrono>
 #include <cmath>
 #include <linux/input.h>
 
@@ -267,8 +266,12 @@ InputEventDT2WSensor::InputEventDT2WSensor(
     if (mPollFds[0] < 0) {
         ALOGE("failed to open poll fd: %d", mPollFds[0]);
     }
+    mPollFds[1] = open(INPUT_TOUCHSCREEN_PATH, O_RDONLY | O_NONBLOCK);
+    if (mPollFds[1] < 0) {
+        ALOGE("failed to open poll fd: %d", mPollFds[1]);
+    }
 
-    if (mWaitPipeFd[0] < 0 || mWaitPipeFd[1] < 0 || mPollFds[0] < 0) {
+    if (mWaitPipeFd[0] < 0 || mWaitPipeFd[1] < 0 || mPollFds[0] < 0 || mPollFds[1] < 0) {
         mStopThread = true;
         return;
     }
@@ -282,6 +285,11 @@ InputEventDT2WSensor::InputEventDT2WSensor(
         .fd = mPollFds[0],
         .events = POLLIN,
     };
+
+    mPolls[2] = {
+        .fd = mPollFds[1],
+        .events = POLLIN,
+    };
 }
 
 InputEventDT2WSensor::~InputEventDT2WSensor() {
@@ -293,6 +301,7 @@ void InputEventDT2WSensor::activate(bool enable) {
 
     if (mIsEnabled != enable) {
         mIsEnabled = enable;
+
         interruptPoll();
         mWaitCV.notify_all();
     }
@@ -306,6 +315,14 @@ void InputEventDT2WSensor::setOperationMode(OperationMode mode) {
 void InputEventDT2WSensor::run() {
     std::unique_lock<std::mutex> runLock(mRunMutex);
 
+    long old_time = 0;
+    long new_time = 0;
+
+    int old_x = 0;
+    int new_x = 0;
+    int old_y = 0;
+    int new_y = 0;
+
     while (!mStopThread) {
         if (!mIsEnabled || mMode == OperationMode::DATA_INJECTION) {
             mWaitCV.wait(runLock, [&] {
@@ -314,7 +331,7 @@ void InputEventDT2WSensor::run() {
         } else {
             // Cannot hold lock while polling.
             runLock.unlock();
-            int rc = poll(mPolls, 2, -1);
+            int rc = poll(mPolls, 3, -1);
             runLock.lock();
 
             struct input_event event;
@@ -330,6 +347,24 @@ void InputEventDT2WSensor::run() {
                     mIsEnabled = false;
                     mCallback->postEvents(readEvents(), isWakeUpSensor());
                 }
+            } else if((mPolls[2].revents == mPolls[2].events) && readEvent(mPolls[2].fd, &event)) {
+                if(event.type == EV_KEY && event.value == 1) { // Touchscreen down/up
+                    old_time = new_time;
+                    new_time = event.time.tv_sec * 1000000 + event.time.tv_usec;
+                    if((new_time - old_time < 200000) && // 200ms
+                       (abs(sqrt(pow(old_x, 2) + pow(old_y, 2)) - sqrt(pow(new_x, 2) + pow(new_y, 2))) < 500)) {
+                        mIsEnabled = false;
+                        mCallback->postEvents(readEvents(), isWakeUpSensor());
+                    }
+                } else if(event.type == EV_ABS) { // send order: touch pos x -> touch y -> down/up
+                    if(event.code == ABS_MT_POSITION_X) {
+                        old_x = new_x;
+                        new_x = event.value;
+                    } else if (event.code == ABS_MT_POSITION_Y) {
+                        old_y = new_y;
+                        new_y = event.value;
+                    }
+                }
             } else if (mPolls[0].revents == mPolls[0].events) {
                 readBool(mWaitPipeFd[0], false /* seek */);
             }
diff --git a/sensors/Sensor.h b/sensors/Sensor.h
index 436c419..538e6d9 100644
--- a/sensors/Sensor.h
+++ b/sensors/Sensor.h
@@ -98,8 +98,11 @@ class InputEventDT2WSensor : public OneShotSensor {
     virtual ~InputEventDT2WSensor() override;
 
     virtual void activate(bool enable) override;
+    virtual void activate(bool enable, bool notify, bool lock);
+    virtual void writeEnable(bool enable);
     virtual void setOperationMode(OperationMode mode) override;
     virtual std::vector<Event> readEvents() override;
+    virtual void fillEventData(Event& event);
 
   protected:
     virtual void run() override;
@@ -109,9 +112,9 @@ class InputEventDT2WSensor : public OneShotSensor {
   private:
     void interruptPoll();
 
-    struct pollfd mPolls[2];
+    struct pollfd mPolls[3];
     int mWaitPipeFd[2];
-    int mPollFds[1];
+    int mPollFds[2];
 };
 
 }  // namespace implementation