From 049ab1da89d389f05870f7e30d585ecfc14524dd Mon Sep 17 00:00:00 2001 From: Baixing Tan Date: Wed, 25 Mar 2015 11:16:57 +0800 Subject: Original code get from ST for lsm6ds3 sensor base on iio subsystem Add original SensorHAL_IIO_v3.1.0 for lsm6ds3 sensor Change-Id: Iebd049a36696f9b1f09049cc8672ed260c12cdf7 Tracked-On: https://jira01.devtools.intel.com/browse/MARVIN-175 Signed-off-by: Baixing Tan Reviewed-on: https://android.intel.com:443/346267 --- libsensors_iio/src/SWGyroscopeUncalibrated.cpp | 49 ++++++++++++++++++++++++++ 1 file changed, 49 insertions(+) create mode 100644 libsensors_iio/src/SWGyroscopeUncalibrated.cpp (limited to 'libsensors_iio/src/SWGyroscopeUncalibrated.cpp') diff --git a/libsensors_iio/src/SWGyroscopeUncalibrated.cpp b/libsensors_iio/src/SWGyroscopeUncalibrated.cpp new file mode 100644 index 0000000..55e8bfe --- /dev/null +++ b/libsensors_iio/src/SWGyroscopeUncalibrated.cpp @@ -0,0 +1,49 @@ +/* + * STMicroelectronics Gyroscope Uncalibrated Sensor Class + * + * Copyright 2013-2015 STMicroelectronics Inc. + * Author: Denis Ciocca - + * + * Licensed under the Apache License, Version 2.0 (the "License"). + */ + +#include +#include +#include + +#include "SWGyroscopeUncalibrated.h" + +SWGyroscopeUncalibrated::SWGyroscopeUncalibrated(const char *name, int handle, int pipe_data_fd) : + SWSensorBaseWithPollrate(name, handle, SENSOR_TYPE_GYROSCOPE_UNCALIBRATED, + pipe_data_fd, true, true, true, true) +{ + sensor_t_data.stringType = SENSOR_STRING_TYPE_GYROSCOPE_UNCALIBRATED; + sensor_t_data.flags = SENSOR_FLAG_CONTINUOUS_MODE; + + type_dependencies[SENSOR_BASE_DEPENDENCY_0] = SENSOR_TYPE_GYROSCOPE; + type_sensor_need_trigger = SENSOR_TYPE_GYROSCOPE; +} + +SWGyroscopeUncalibrated::~SWGyroscopeUncalibrated() +{ + +} + +void SWGyroscopeUncalibrated::TriggerEventReceived() +{ + int data_remaining; + SensorBaseData gyro_data; + + do { + data_remaining = GetLatestValidDataFromDependency(SENSOR_BASE_DEPENDENCY_0, &gyro_data); + if (data_remaining < 0) + return; + + memcpy(sensor_event.uncalibrated_gyro.uncalib, gyro_data.raw, num_data_axis * sizeof(float)); + memcpy(sensor_event.uncalibrated_gyro.bias, gyro_data.offset, num_data_axis * sizeof(float)); + sensor_event.timestamp = gyro_data.timestamp; + + SWSensorBaseWithPollrate::WriteDataToPipe(); + SWSensorBaseWithPollrate::ProcessData(&gyro_data); + } while (data_remaining > 0); +} -- cgit v1.2.3