diff options
author | Paul Kocialkowski <contact@paulk.fr> | 2014-01-13 16:29:05 +0100 |
---|---|---|
committer | Paul Kocialkowski <contact@paulk.fr> | 2014-01-14 11:05:38 +0100 |
commit | 41e1ee0fc6771728ccc72074ab773e6436b3a5d7 (patch) | |
tree | 4df40f3dc005b6873bc516cea5dd73668d3a2b26 /sensors/orientationd/bma250.c | |
parent | f970560dbc0e85c6a012c291e6dd848cb3bc8b95 (diff) | |
download | device_samsung_p3100-41e1ee0fc6771728ccc72074ab773e6436b3a5d7.zip device_samsung_p3100-41e1ee0fc6771728ccc72074ab773e6436b3a5d7.tar.gz device_samsung_p3100-41e1ee0fc6771728ccc72074ab773e6436b3a5d7.tar.bz2 |
Piranha Sensors
Signed-off-by: Paul Kocialkowski <contact@paulk.fr>
Diffstat (limited to 'sensors/orientationd/bma250.c')
-rw-r--r-- | sensors/orientationd/bma250.c | 85 |
1 files changed, 85 insertions, 0 deletions
diff --git a/sensors/orientationd/bma250.c b/sensors/orientationd/bma250.c new file mode 100644 index 0000000..88819ea --- /dev/null +++ b/sensors/orientationd/bma250.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 bma250_convert(int value) +{ + return value * (GRAVITY_EARTH / 256.0f); +} + +int bma250_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->acceleration.x = bma250_convert(input_event.value); + break; + case ABS_Y: + data->acceleration.y = bma250_convert(input_event.value); + break; + case ABS_Z: + data->acceleration.z = bma250_convert(input_event.value); + break; + default: + continue; + } + } + } while (input_event.type != EV_SYN); + + return 0; +} + +struct orientationd_handlers bma250 = { + .input_name = "accelerometer", + .handle = SENSOR_TYPE_ACCELEROMETER, + .poll_fd = -1, + .get_data = bma250_get_data, +}; |