Zbigniew Jędrzejewski-Szmek 43ff24
From e27bfc22bba932950a398b32bf57be6f825438ee Mon Sep 17 00:00:00 2001
Zbigniew Jędrzejewski-Szmek 43ff24
From: Bastien Nocera <hadess@hadess.net>
Zbigniew Jędrzejewski-Szmek 43ff24
Date: Tue, 8 Jul 2014 18:29:06 +0200
Zbigniew Jędrzejewski-Szmek 43ff24
Subject: [PATCH] accelerometer: Don't wait for new data from the sensor
Zbigniew Jędrzejewski-Szmek 43ff24
Zbigniew Jędrzejewski-Szmek 43ff24
Instead of waiting for new data from the sensor, which might be
Zbigniew Jędrzejewski-Szmek 43ff24
a long time coming, depending on the sensor device, ask the kernel
Zbigniew Jędrzejewski-Szmek 43ff24
for the last state for that particular input device.
Zbigniew Jędrzejewski-Szmek 43ff24
Zbigniew Jędrzejewski-Szmek 43ff24
(cherry picked from commit a545c6e1aa31b4d7e80c9d3609d9fc4fc9921498)
Zbigniew Jędrzejewski-Szmek 43ff24
---
Zbigniew Jędrzejewski-Szmek 43ff24
 src/udev/accelerometer/accelerometer.c | 33 ++++++---------------------------
Zbigniew Jędrzejewski-Szmek 43ff24
 1 file changed, 6 insertions(+), 27 deletions(-)
Zbigniew Jędrzejewski-Szmek 43ff24
Zbigniew Jędrzejewski-Szmek 43ff24
diff --git a/src/udev/accelerometer/accelerometer.c b/src/udev/accelerometer/accelerometer.c
Zbigniew Jędrzejewski-Szmek 43ff24
index 925d38de1f..32adf27777 100644
Zbigniew Jędrzejewski-Szmek 43ff24
--- a/src/udev/accelerometer/accelerometer.c
Zbigniew Jędrzejewski-Szmek 43ff24
+++ b/src/udev/accelerometer/accelerometer.c
Zbigniew Jędrzejewski-Szmek 43ff24
@@ -180,7 +180,7 @@ get_prev_orientation(struct udev_device *dev)
Zbigniew Jędrzejewski-Szmek 43ff24
         return string_to_orientation(value);
Zbigniew Jędrzejewski-Szmek 43ff24
 }
Zbigniew Jędrzejewski-Szmek 43ff24
 
Zbigniew Jędrzejewski-Szmek 43ff24
-#define SET_AXIS(axis, code_) if (ev[i].code == code_) { if (got_##axis == 0) { axis = ev[i].value; got_##axis = true; } }
Zbigniew Jędrzejewski-Szmek 43ff24
+#define READ_AXIS(axis, var) { memzero(&abs_info, sizeof(abs_info)); r = ioctl(fd, EVIOCGABS(axis), &abs_info); if (r < 0) return; var = abs_info.value; }
Zbigniew Jędrzejewski-Szmek 43ff24
 
Zbigniew Jędrzejewski-Szmek 43ff24
 /* accelerometers */
Zbigniew Jędrzejewski-Szmek 43ff24
 static void test_orientation(struct udev *udev,
Zbigniew Jędrzejewski-Szmek 43ff24
@@ -189,10 +189,9 @@ static void test_orientation(struct udev *udev,
Zbigniew Jędrzejewski-Szmek 43ff24
 {
Zbigniew Jędrzejewski-Szmek 43ff24
         OrientationUp old, new;
Zbigniew Jędrzejewski-Szmek 43ff24
         _cleanup_close_ int fd = -1;
Zbigniew Jędrzejewski-Szmek 43ff24
-        struct input_event ev[64];
Zbigniew Jędrzejewski-Szmek 43ff24
-        bool got_syn = false;
Zbigniew Jędrzejewski-Szmek 43ff24
-        bool got_x = false, got_y = false, got_z = false;
Zbigniew Jędrzejewski-Szmek 43ff24
+        struct input_absinfo abs_info;
Zbigniew Jędrzejewski-Szmek 43ff24
         int x = 0, y = 0, z = 0;
Zbigniew Jędrzejewski-Szmek 43ff24
+        int r;
Zbigniew Jędrzejewski-Szmek 43ff24
         char text[64];
Zbigniew Jędrzejewski-Szmek 43ff24
 
Zbigniew Jędrzejewski-Szmek 43ff24
         old = get_prev_orientation(dev);
Zbigniew Jędrzejewski-Szmek 43ff24
@@ -201,30 +200,10 @@ static void test_orientation(struct udev *udev,
Zbigniew Jędrzejewski-Szmek 43ff24
         if (fd < 0)
Zbigniew Jędrzejewski-Szmek 43ff24
                 return;
Zbigniew Jędrzejewski-Szmek 43ff24
 
Zbigniew Jędrzejewski-Szmek 43ff24
-        while (1) {
Zbigniew Jędrzejewski-Szmek 43ff24
-                int i, r;
Zbigniew Jędrzejewski-Szmek 43ff24
-
Zbigniew Jędrzejewski-Szmek 43ff24
-                r = read(fd, ev, sizeof(struct input_event) * 64);
Zbigniew Jędrzejewski-Szmek 43ff24
-
Zbigniew Jędrzejewski-Szmek 43ff24
-                if (r < (int) sizeof(struct input_event))
Zbigniew Jędrzejewski-Szmek 43ff24
-                        return;
Zbigniew Jędrzejewski-Szmek 43ff24
-
Zbigniew Jędrzejewski-Szmek 43ff24
-                for (i = 0; i < r / (int) sizeof(struct input_event); i++) {
Zbigniew Jędrzejewski-Szmek 43ff24
-                        if (got_syn) {
Zbigniew Jędrzejewski-Szmek 43ff24
-                                if (ev[i].type == EV_ABS) {
Zbigniew Jędrzejewski-Szmek 43ff24
-                                        SET_AXIS(x, ABS_X);
Zbigniew Jędrzejewski-Szmek 43ff24
-                                        SET_AXIS(y, ABS_Y);
Zbigniew Jędrzejewski-Szmek 43ff24
-                                        SET_AXIS(z, ABS_Z);
Zbigniew Jędrzejewski-Szmek 43ff24
-                                }
Zbigniew Jędrzejewski-Szmek 43ff24
-                        }
Zbigniew Jędrzejewski-Szmek 43ff24
-                        if (ev[i].type == EV_SYN && ev[i].code == SYN_REPORT)
Zbigniew Jędrzejewski-Szmek 43ff24
-                                got_syn = true;
Zbigniew Jędrzejewski-Szmek 43ff24
-                        if (got_x && got_y && got_z)
Zbigniew Jędrzejewski-Szmek 43ff24
-                                goto read_dev;
Zbigniew Jędrzejewski-Szmek 43ff24
-                }
Zbigniew Jędrzejewski-Szmek 43ff24
-        }
Zbigniew Jędrzejewski-Szmek 43ff24
+        READ_AXIS(ABS_X, x);
Zbigniew Jędrzejewski-Szmek 43ff24
+        READ_AXIS(ABS_Y, y);
Zbigniew Jędrzejewski-Szmek 43ff24
+        READ_AXIS(ABS_Z, z);
Zbigniew Jędrzejewski-Szmek 43ff24
 
Zbigniew Jędrzejewski-Szmek 43ff24
-read_dev:
Zbigniew Jędrzejewski-Szmek 43ff24
         new = orientation_calc(old, x, y, z);
Zbigniew Jędrzejewski-Szmek 43ff24
         snprintf(text, sizeof(text),
Zbigniew Jędrzejewski-Szmek 43ff24
                  "ID_INPUT_ACCELEROMETER_ORIENTATION=%s", orientation_to_string(new));