2 files changed, 12 insertions, 1 deletions
diff --git a/modules/sensors/dynamic_sensor/HidRawSensorDevice.cpp b/modules/sensors/dynamic_sensor/HidRawSensorDevice.cpp
index 8aa4cf92..5bc4abc2 100644
--- a/modules/sensors/dynamic_sensor/HidRawSensorDevice.cpp
+++ b/modules/sensors/dynamic_sensor/HidRawSensorDevice.cpp
@@ -35,6 +35,15 @@ using namespace Hid::Sensor::PropertyUsage;
 const std::unordered_set<unsigned int> HidRawSensorDevice::sInterested{
         ACCELEROMETER_3D, GYROMETER_3D, COMPASS_3D, CUSTOM};
 
+void HidRawSensorDevice::enableSchedFifoMode() {
+  constexpr int kHidRawSensorPriority = 10;  // Matches with sensor service priority
+  struct sched_param param = {0};
+  param.sched_priority = kHidRawSensorPriority;
+  if (sched_setscheduler(getTid(), SCHED_FIFO | SCHED_RESET_ON_FORK, &param) != 0) {
+    ALOGE("Couldn't set SCHED_FIFO for HidRawSensor thread: %s", strerror(errno));
+  }
+}
+
 sp<HidRawSensorDevice> HidRawSensorDevice::create(const std::string &devName) {
     sp<HidRawSensorDevice> device(new HidRawSensorDevice(devName));
     // offset +1 strong count added by constructor
@@ -74,7 +83,8 @@ HidRawSensorDevice::HidRawSensorDevice(const std::string &devName)
         return;
     }
 
-    run("HidRawSensor");
+    run("HidRawSensor", PRIORITY_URGENT_DISPLAY);
+    enableSchedFifoMode();
     mValid = true;
 }
 
diff --git a/modules/sensors/dynamic_sensor/HidRawSensorDevice.h b/modules/sensors/dynamic_sensor/HidRawSensorDevice.h
index 06d435e7..7818bf16 100644
--- a/modules/sensors/dynamic_sensor/HidRawSensorDevice.h
+++ b/modules/sensors/dynamic_sensor/HidRawSensorDevice.h
@@ -41,6 +41,7 @@ private:
 
     // constructor will result in +1 strong count
     explicit HidRawSensorDevice(const std::string &devName);
+    void enableSchedFifoMode();
     // implement function of Thread
     virtual bool threadLoop() override;
     std::unordered_map<unsigned int/*reportId*/, sp<HidRawSensor>> mSensors;