From 5cdad8ef873758b192c20d5eeb4b2afd86068e2b Mon Sep 17 00:00:00 2001
From: Pawit Pornkitprasan <p.pawit@gmail.com>
Date: Sat, 26 Nov 2011 08:49:42 +0700
Subject: aries-common: Implement libsensors setDelay

Change-Id: Ibc1bae37d3fd791eb7b24824a899ba3932e9c5e8
(cherry picked from commit 241d5c032e64569128eb11a754cb6ee359b25380)
---
 libsensors/CompassSensor.cpp     | 24 ++++++++++++++++++------
 libsensors/OrientationSensor.cpp | 24 ++++++++++++++++++------
 libsensors/Smb380Sensor.cpp      | 24 ++++++++++++++++++------
 3 files changed, 54 insertions(+), 18 deletions(-)

(limited to 'libsensors')

diff --git a/libsensors/CompassSensor.cpp b/libsensors/CompassSensor.cpp
index c4b6822..cea0249 100644
--- a/libsensors/CompassSensor.cpp
+++ b/libsensors/CompassSensor.cpp
@@ -106,12 +106,24 @@ bool CompassSensor::hasPendingEvents() const {
 
 int CompassSensor::setDelay(int32_t handle, int64_t ns)
 {
-    LOGD("CompassSensor::~setDelay(%d, %d)", handle, ns);
-    /* FIXME needs changes to the kernel driver.
-       We need to add a IOCTL that can set the samplingrate
-       the driver in ther kernel supports this allready only need
-       to add a IOCTL on both sides for that*/
-    return 0;
+    LOGD("CompassSensor::~setDelay(%d, %lld)", handle, ns);
+
+    int fd;
+
+    if (ns < 10000000) {
+        ns = 10000000; // Minimum on stock
+    }
+
+    strcpy(&input_sysfs_path[input_sysfs_path_len], "delay");
+    fd = open(input_sysfs_path, O_RDWR);
+    if (fd >= 0) {
+        char buf[80];
+        sprintf(buf, "%lld", ns / 10000000 * 10); // Some flooring to match stock value
+        write(fd, buf, strlen(buf)+1);
+        close(fd);
+        return 0;
+    }
+    return -1;
 }
 
 
diff --git a/libsensors/OrientationSensor.cpp b/libsensors/OrientationSensor.cpp
index 3fb5d29..2925ba7 100644
--- a/libsensors/OrientationSensor.cpp
+++ b/libsensors/OrientationSensor.cpp
@@ -103,12 +103,24 @@ bool OrientationSensor::hasPendingEvents() const {
 
 int OrientationSensor::setDelay(int32_t handle, int64_t ns)
 {
-    LOGD("OrientationSensor::~setDelay(%d, %d)", handle, ns);
-    /* FIXME needs changes to the kernel driver.
-       We need to add a IOCTL that can set the samplingrate
-       the driver in ther kernel supports this allready only need
-       to add a IOCTL on both sides for that*/
-    return 0;
+    LOGD("OrientationSensor::~setDelay(%d, %lld)", handle, ns);
+
+    int fd;
+
+    if (ns < 10000000) {
+        ns = 10000000; // Minimum on stock
+    }
+
+    strcpy(&input_sysfs_path[input_sysfs_path_len], "delay");
+    fd = open(input_sysfs_path, O_RDWR);
+    if (fd >= 0) {
+        char buf[80];
+        sprintf(buf, "%lld", ns / 10000000 * 10); // Some flooring to match stock value
+        write(fd, buf, strlen(buf)+1);
+        close(fd);
+        return 0;
+    }
+    return -1;
 }
 
 
diff --git a/libsensors/Smb380Sensor.cpp b/libsensors/Smb380Sensor.cpp
index 3de4d9b..feb1b22 100644
--- a/libsensors/Smb380Sensor.cpp
+++ b/libsensors/Smb380Sensor.cpp
@@ -105,12 +105,24 @@ bool Smb380Sensor::hasPendingEvents() const {
 
 int Smb380Sensor::setDelay(int32_t handle, int64_t ns)
 {
-    LOGD("Smb380Sensor::~setDelay(%d, %d)", handle, ns);
-    /* FIXME needs changes to the kernel driver.
-       We need to add a IOCTL that can set the samplingrate
-       the driver in ther kernel supports this allready only need
-       to add a IOCTL on both sides for that*/
-    return 0;
+    LOGD("Smb380Sensor::~setDelay(%d, %lld)", handle, ns);
+
+    int fd;
+
+    if (ns < 10000000) {
+        ns = 10000000; // Minimum on stock
+    }
+
+    strcpy(&input_sysfs_path[input_sysfs_path_len], "delay");
+    fd = open(input_sysfs_path, O_RDWR);
+    if (fd >= 0) {
+        char buf[80];
+        sprintf(buf, "%lld", ns / 10000000 * 10); // Some flooring to match stock value
+        write(fd, buf, strlen(buf)+1);
+        close(fd);
+        return 0;
+    }
+    return -1;
 }
 
 
-- 
cgit v1.1