colin/iio-sensor-proxy
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

proximity: Read near level from udev property

Browse Source 
The levels are sensor dependend and are also affected by how the sensor
is built into the device (e.g. the distance to the cover glass).

Android even does this in sensor specific code. Android x86 works
around this by using setprop:

https://groups.google.com/forum/#!topic/android-x86/RFXYW5MNCuk
This commit is contained in:
Guido Günther
2020-02-10 11:50:09 +01:00
committed by Bastien Nocera
parent 7024b9c45a
commit 11778ab603
1 changed files with 27 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files

31
src/drv-iio-poll-proximity.c
View File

@@ -16,8 +16,7 @@
#include <stdio.h> #include <stdio.h>
#include <stdlib.h> #include <stdlib.h>
/* FIXME: This needs to come from udev since it's device dependent */ #define PROXIMITY_NEAR_LEVEL "PROXIMITY_NEAR_LEVEL"
#define NEAR_LEVEL 200
typedef struct DrvData { typedef struct DrvData {
guint timeout_id; guint timeout_id;
@@ -25,6 +24,7 @@ typedef struct DrvData {
gpointer user_data; gpointer user_data;
GUdevDevice *dev; GUdevDevice *dev;
const char *name; const char *name;
gint near_level;
} DrvData; } DrvData;
static DrvData *drv_data = NULL; static DrvData *drv_data = NULL;
@@ -57,8 +57,8 @@ poll_proximity (gpointer user_data)
/* g_udev_device_get_sysfs_attr_as_int does not update when there's no event */ /* g_udev_device_get_sysfs_attr_as_int does not update when there's no event */
prox = sysfs_get_int (data->dev, "in_proximity_raw"); prox = sysfs_get_int (data->dev, "in_proximity_raw");
readings.is_near = (prox > NEAR_LEVEL) ? TRUE : FALSE; readings.is_near = (prox > data->near_level) ? PROXIMITY_NEAR_TRUE : PROXIMITY_NEAR_FALSE;
g_debug ("Proximity read from IIO on '%s': %d, near: %d", data->name, prox, readings.is_near); g_debug ("Proximity read from IIO on '%s': %d/%d, near: %d", data->name, prox, data->near_level, readings.is_near);
drv_data->callback_func (&iio_poll_proximity, (gpointer) &readings, drv_data->user_data); drv_data->callback_func (&iio_poll_proximity, (gpointer) &readings, drv_data->user_data);
@@ -91,6 +91,23 @@ iio_poll_proximity_set_polling (gboolean state)
} }
} }
static gint
get_near_level (GUdevDevice *device)
{
gint near_level;
near_level = g_udev_device_get_property_as_int (device, PROXIMITY_NEAR_LEVEL);
if (!near_level) {
g_warning ("Found proximity sensor but no " PROXIMITY_NEAR_LEVEL " udev property");
g_warning ("See https://gitlab.freedesktop.org/hadess/iio-sensor-proxy/blob/master/README.md");
return 0;
}
g_debug ("Near level: %d", near_level);
return near_level;
}
static gboolean static gboolean
iio_poll_proximity_open (GUdevDevice *device, iio_poll_proximity_open (GUdevDevice *device,
ReadingsUpdateFunc callback_func, ReadingsUpdateFunc callback_func,
@@ -103,6 +120,12 @@ iio_poll_proximity_open (GUdevDevice *device,
drv_data->name = g_udev_device_get_sysfs_attr (device, "name"); drv_data->name = g_udev_device_get_sysfs_attr (device, "name");
drv_data->callback_func = callback_func; drv_data->callback_func = callback_func;
drv_data->user_data = user_data; drv_data->user_data = user_data;
drv_data->near_level = get_near_level (device);
if (!drv_data->near_level) {
g_free (drv_data);
return FALSE;
}
return TRUE; return TRUE;
} }