iio-sensors: Add suport for STEP_DETECTOR sensor

[android-x86/hardware-intel-libsensors.git] / utils.c

diff --git a/utils.c b/utils.c
index f37f782..718b444 100644 (file)
--- a/utils.c
+++ b/utils.c
@@ -4,6 +4,7 @@
 
 #include <stdlib.h>
 #include <fcntl.h>
+#include <sys/ioctl.h>
 #include <utils/Log.h>
 #include <hardware/sensors.h>
 #include <utils/Atomic.h>
@@ -224,40 +225,42 @@ int sysfs_read_float(const char path[PATH_MAX], float *value)
        return 0;
 }
 
-
-int decode_type_spec(  const char type_buf[MAX_TYPE_SPEC_LEN],
-                       struct datum_info_t *type_info)
+int sysfs_read_uint64(const char path[PATH_MAX], uint64_t *value)
 {
-       /* Return size in bytes for this type specification, or -1 in error */
-       char sign;
-       char endianness;
-       unsigned int realbits, storagebits, shift;
-       int tokens;
-
-       /* Valid specs: "le:u10/16>>0", "le:s16/32>>0" or "le:s32/32>>0" */
-
-       tokens = sscanf(type_buf, "%ce:%c%u/%u>>%u",
-                       &endianness, &sign, &realbits, &storagebits, &shift);
-
-       if     (tokens != 5 ||
-               (endianness != 'b' && endianness != 'l') ||
-               (sign != 'u' && sign != 's') ||
-               realbits > storagebits ||
-               (storagebits != 16 && storagebits != 32 && storagebits != 64)) {
-                       ALOGE("Invalid iio channel type spec: %s\n", type_buf);
-                       return -1;
-               }
-
-       type_info->endianness   =               endianness;
-       type_info->sign         =               sign;
-       type_info->realbits     =       (short) realbits;
-       type_info->storagebits  =       (short) storagebits;
-       type_info->shift        =       (short) shift;
-
-       return storagebits / 8;
+       int fd;
+       int len;
+       char buf[20] = {0};
+
+       if (!path[0] || !value) {
+               return -1;
+       }
+
+       fd = open(path, O_RDONLY);
+
+       if (fd == -1) {
+               ALOGV("Cannot open %s (%s)\n", path, strerror(errno));
+               return -1;
+       }
+
+       len = read(fd, buf, sizeof(buf));
+
+       close(fd);
+
+       if (len <= 0) {
+               ALOGW("Cannot read uint64 from %s (%s)\n", path,
+                     strerror(errno));
+               return -1;
+       }
+
+       *value =  atoll(buf);
+
+       ALOGV("Read %llu from %s\n", *value, path);
+
+       return 0;
 }
 
 
+
 int64_t get_timestamp_realtime (void)
 {
        struct timespec ts = {0};