libsensors/invensense: Clean-up.

2 files changed, 12 insertions, 0 deletions

diff --git a/libsensors/SamsungSensorBase.cpp b/libsensors/SamsungSensorBase.cpp
index 49ba7e8..0492d94 100644
--- a/libsensors/SamsungSensorBase.cpp
+++ b/libsensors/SamsungSensorBase.cpp
@@ -139,6 +139,13 @@ done:
     return result;
 }
 
+int64_t SamsungSensorBase::getTimestamp() {
+    struct timespec t;
+    t.tv_sec = t.tv_nsec = 0;
+    clock_gettime(CLOCK_BOOTTIME, &t);
+    return int64_t(t.tv_sec)*1000000000LL + t.tv_nsec;
+}
+
 int SamsungSensorBase::readEvents(sensors_event_t* data, int count)
 {
     if (count < 1)
diff --git a/libsensors/SamsungSensorBase.h b/libsensors/SamsungSensorBase.h
index c989c71..1440e37 100644
--- a/libsensors/SamsungSensorBase.h
+++ b/libsensors/SamsungSensorBase.h
@@ -40,6 +40,11 @@ protected:
     int mSensorCode;
     pthread_mutex_t mLock;
 
+    static int64_t getTimestamp();
+    static int64_t timevalToNano(timeval const& t) {
+        return t.tv_sec*1000000000LL + t.tv_usec*1000;
+    }
+
     char *makeSysfsName(const char *input_name,
                         const char *input_file);