aboutsummaryrefslogtreecommitdiff
path: root/sensors/Gyroscope.cpp
diff options
context:
space:
mode:
Diffstat (limited to 'sensors/Gyroscope.cpp')
-rw-r--r--sensors/Gyroscope.cpp278
1 files changed, 0 insertions, 278 deletions
diff --git a/sensors/Gyroscope.cpp b/sensors/Gyroscope.cpp
deleted file mode 100644
index 3ae2cb8..0000000
--- a/sensors/Gyroscope.cpp
+++ /dev/null
@@ -1,278 +0,0 @@
-/*
- * Copyright (c) 2014, The Linux Foundation. All rights reserved.
- * Not a Contribution.
- * Copyright (C) 2008 The Android Open Source Project
- *
- * Licensed under the Apache License, Version 2.0 (the "License");
- * you may not use this file except in compliance with the License.
- * You may obtain a copy of the License at
- *
- * http://www.apache.org/licenses/LICENSE-2.0
- *
- * Unless required by applicable law or agreed to in writing, software
- * distributed under the License is distributed on an "AS IS" BASIS,
- * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
- * See the License for the specific language governing permissions and
- * limitations under the License.
- */
-
-#include <fcntl.h>
-#include <errno.h>
-#include <math.h>
-#include <poll.h>
-#include <unistd.h>
-#include <dirent.h>
-#include <sys/select.h>
-#include <cutils/log.h>
-#include <cutils/properties.h>
-
-#include "GyroSensor.h"
-#include "sensors.h"
-
-#define GYRO_INPUT_DEV_NAME "gyroscope"
-
-#define FETCH_FULL_EVENT_BEFORE_RETURN 1
-#define IGNORE_EVENT_TIME 350000000
-
-#define EVENT_TYPE_GYRO_X ABS_RX
-#define EVENT_TYPE_GYRO_Y ABS_RY
-#define EVENT_TYPE_GYRO_Z ABS_RZ
-
-#define GYROSCOPE_CONVERT (M_PI / (180 * 16.4))
-#define CONVERT_GYRO_X (-GYROSCOPE_CONVERT)
-#define CONVERT_GYRO_Y ( GYROSCOPE_CONVERT)
-#define CONVERT_GYRO_Z (-GYROSCOPE_CONVERT)
-
-/*****************************************************************************/
-
-GyroSensor::GyroSensor()
- : SensorBase(NULL, GYRO_INPUT_DEV_NAME),
- mEnabled(0),
- mInputReader(6),
- mHasPendingEvent(false),
- mEnabledTime(0)
-{
- mPendingEvent.version = sizeof(sensors_event_t);
- mPendingEvent.sensor = SENSORS_GYROSCOPE_HANDLE;
- mPendingEvent.type = SENSOR_TYPE_GYROSCOPE;
- memset(mPendingEvent.data, 0, sizeof(mPendingEvent.data));
-
- if (data_fd) {
- strlcpy(input_sysfs_path, "/sys/class/input/", sizeof(input_sysfs_path));
- strlcat(input_sysfs_path, input_name, sizeof(input_sysfs_path));
- strlcat(input_sysfs_path, "/device/device/", sizeof(input_sysfs_path));
- input_sysfs_path_len = strlen(input_sysfs_path);
- enable(0, 1);
- }
-}
-
-GyroSensor::GyroSensor(struct SensorContext *context)
- : SensorBase(NULL, NULL),
- mEnabled(0),
- mInputReader(6),
- mHasPendingEvent(false),
- mEnabledTime(0)
-{
- mPendingEvent.version = sizeof(sensors_event_t);
- mPendingEvent.sensor = context->sensor->handle;
- mPendingEvent.type = SENSOR_TYPE_GYROSCOPE;
- memset(mPendingEvent.data, 0, sizeof(mPendingEvent.data));
- data_fd = context->data_fd;
- strlcpy(input_sysfs_path, context->enable_path, sizeof(input_sysfs_path));
- input_sysfs_path_len = strlen(input_sysfs_path);
- mUseAbsTimeStamp = false;
-
- enable(0, 1);
-}
-
-GyroSensor::GyroSensor(char *name)
- : SensorBase(NULL, GYRO_INPUT_DEV_NAME),
- mEnabled(0),
- mInputReader(6),
- mHasPendingEvent(false),
- mEnabledTime(0)
-{
- mPendingEvent.version = sizeof(sensors_event_t);
- mPendingEvent.sensor = SENSORS_GYROSCOPE_HANDLE;
- mPendingEvent.type = SENSOR_TYPE_GYROSCOPE;
- memset(mPendingEvent.data, 0, sizeof(mPendingEvent.data));
-
- if (data_fd) {
- strlcpy(input_sysfs_path, SYSFS_CLASS, sizeof(input_sysfs_path));
- strlcat(input_sysfs_path, name, sizeof(input_sysfs_path));
- strlcat(input_sysfs_path, "/", sizeof(input_sysfs_path));
- input_sysfs_path_len = strlen(input_sysfs_path);
- ALOGI("The gyroscope sensor path is %s",input_sysfs_path);
- enable(0, 1);
- }
-}
-
-GyroSensor::~GyroSensor() {
- if (mEnabled) {
- enable(0, 0);
- }
-}
-
-int GyroSensor::setInitialState() {
- struct input_absinfo absinfo_x;
- struct input_absinfo absinfo_y;
- struct input_absinfo absinfo_z;
- float value;
- if (!ioctl(data_fd, EVIOCGABS(EVENT_TYPE_GYRO_X), &absinfo_x) &&
- !ioctl(data_fd, EVIOCGABS(EVENT_TYPE_GYRO_Y), &absinfo_y) &&
- !ioctl(data_fd, EVIOCGABS(EVENT_TYPE_GYRO_Z), &absinfo_z)) {
- value = absinfo_x.value;
- mPendingEvent.data[0] = value * CONVERT_GYRO_X;
- value = absinfo_y.value;
- mPendingEvent.data[1] = value * CONVERT_GYRO_Y;
- value = absinfo_z.value;
- mPendingEvent.data[2] = value * CONVERT_GYRO_Z;
- mHasPendingEvent = true;
- }
- return 0;
-}
-
-int GyroSensor::enable(int32_t, int en) {
- int flags = en ? 1 : 0;
- char propBuf[PROPERTY_VALUE_MAX];
- property_get("sensors.gyro.loopback", propBuf, "0");
- if (strcmp(propBuf, "1") == 0) {
- mEnabled = flags;
- ALOGE("sensors.gyro.loopback is set");
- return 0;
- }
- if (flags != mEnabled) {
- int fd;
- strlcpy(&input_sysfs_path[input_sysfs_path_len],
- SYSFS_ENABLE, SYSFS_MAXLEN);
- fd = open(input_sysfs_path, O_RDWR);
- if (fd >= 0) {
- char buf[2];
- int err;
- buf[1] = 0;
- if (flags) {
- buf[0] = '1';
- mEnabledTime = getTimestamp() + IGNORE_EVENT_TIME;
- } else {
- buf[0] = '0';
- }
- err = write(fd, buf, sizeof(buf));
- close(fd);
- mEnabled = flags;
- setInitialState();
- return 0;
- }
- return -1;
- }
- return 0;
-}
-
-bool GyroSensor::hasPendingEvents() const {
- return mHasPendingEvent;
-}
-
-int GyroSensor::setDelay(int32_t, int64_t delay_ns)
-{
- int fd;
- char propBuf[PROPERTY_VALUE_MAX];
- property_get("sensors.gyro.loopback", propBuf, "0");
- if (strcmp(propBuf, "1") == 0) {
- ALOGE("sensors.gyro.loopback is set");
- return 0;
- }
- int delay_ms = delay_ns / 1000000;
- strlcpy(&input_sysfs_path[input_sysfs_path_len],
- SYSFS_POLL_DELAY, SYSFS_MAXLEN);
- fd = open(input_sysfs_path, O_RDWR);
- if (fd >= 0) {
- char buf[80];
- sprintf(buf, "%d", delay_ms);
- write(fd, buf, strlen(buf)+1);
- close(fd);
- return 0;
- }
- return -1;
-}
-
-int GyroSensor::readEvents(sensors_event_t* data, int count)
-{
- if (count < 1)
- return -EINVAL;
-
- if (mHasPendingEvent) {
- mHasPendingEvent = false;
- mPendingEvent.timestamp = getTimestamp();
- *data = mPendingEvent;
- return mEnabled ? 1 : 0;
- }
-
- ssize_t n = mInputReader.fill(data_fd);
- if (n < 0)
- return n;
-
- int numEventReceived = 0;
- input_event const* event;
-
-#if FETCH_FULL_EVENT_BEFORE_RETURN
-again:
-#endif
- while (count && mInputReader.readEvent(&event)) {
- int type = event->type;
- if (type == EV_ABS) {
- float value = event->value;
- if (event->code == EVENT_TYPE_GYRO_X) {
- mPendingEvent.data[0] = value * CONVERT_GYRO_X;
- } else if (event->code == EVENT_TYPE_GYRO_Y) {
- mPendingEvent.data[1] = value * CONVERT_GYRO_Y;
- } else if (event->code == EVENT_TYPE_GYRO_Z) {
- mPendingEvent.data[2] = value * CONVERT_GYRO_Z;
- }
- } else if (type == EV_SYN) {
- switch ( event->code ){
- case SYN_TIME_SEC:
- {
- mUseAbsTimeStamp = true;
- report_time = event->value*1000000000LL;
- }
- break;
- case SYN_TIME_NSEC:
- {
- mUseAbsTimeStamp = true;
- mPendingEvent.timestamp = report_time+event->value;
- }
- break;
- case SYN_REPORT:
- {
- if (mEnabled && mUseAbsTimeStamp) {
- if(mPendingEvent.timestamp >= mEnabledTime) {
- *data++ = mPendingEvent;
- numEventReceived++;
- }
- count--;
- mUseAbsTimeStamp = false;
- } else {
- ALOGE_IF(!mUseAbsTimeStamp, "GyroSensor:timestamp not received");
- }
- }
- break;
- }
- } else {
- ALOGE("GyroSensor: unknown event (type=%d, code=%d)",
- type, event->code);
- }
- mInputReader.next();
- }
-
-#if FETCH_FULL_EVENT_BEFORE_RETURN
- /* if we didn't read a complete event, see if we can fill and
- try again instead of returning with nothing and redoing poll. */
- if (numEventReceived == 0 && mEnabled == 1) {
- n = mInputReader.fill(data_fd);
- if (n)
- goto again;
- }
-#endif
-
- return numEventReceived;
-}
-
generated by cgit v1.2.3 (git 2.25.1) at 2025-12-20 00:35:46 +0000