diff options
Diffstat (limited to 'libsensors/orientationd/yas530.c')
-rw-r--r-- | libsensors/orientationd/yas530.c | 85 |
1 files changed, 85 insertions, 0 deletions
diff --git a/libsensors/orientationd/yas530.c b/libsensors/orientationd/yas530.c new file mode 100644 index 0000000..7942c50 --- /dev/null +++ b/libsensors/orientationd/yas530.c @@ -0,0 +1,85 @@ +/* + * Copyright (C) 2013 Paul Kocialkowski <contact@paulk.fr> + * + * This program is free software: you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation, either version 3 of the License, or + * (at your option) any later version. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with this program. If not, see <http://www.gnu.org/licenses/>. + */ + +#include <stdlib.h> +#include <unistd.h> +#include <stdint.h> +#include <fcntl.h> +#include <errno.h> +#include <math.h> +#include <sys/types.h> +#include <linux/ioctl.h> +#include <linux/input.h> + +#include <hardware/sensors.h> +#include <hardware/hardware.h> + +#define LOG_TAG "orientationd" +#include <utils/Log.h> + +#include "orientationd.h" + +float yas530_convert(int value) +{ + return value / 1000.0f; +} + +int yas530_get_data(struct orientationd_handlers *handlers, + struct orientationd_data *data) +{ + struct input_event input_event; + int input_fd; + int rc; + + if (handlers == NULL || data == NULL) + return -EINVAL; + + input_fd = handlers->poll_fd; + if (input_fd < 0) + return -1; + + do { + rc = read(input_fd, &input_event, sizeof(input_event)); + if (rc < (int) sizeof(input_event)) + break; + + if (input_event.type == EV_ABS) { + switch (input_event.code) { + case ABS_X: + data->magnetic.x = yas530_convert(input_event.value); + break; + case ABS_Y: + data->magnetic.y = yas530_convert(input_event.value); + break; + case ABS_Z: + data->magnetic.z = yas530_convert(input_event.value); + break; + default: + continue; + } + } + } while (input_event.type != EV_SYN); + + return 0; +} + +struct orientationd_handlers yas530 = { + .input_name = "geomagnetic", + .handle = SENSOR_TYPE_MAGNETIC_FIELD, + .poll_fd = -1, + .get_data = yas530_get_data, +}; |