1 /* 2 * Copyright (C) 2011 The Android Open Source Project 3 * 4 * Licensed under the Apache License, Version 2.0 (the "License"); 5 * you may not use this file except in compliance with the License. 6 * You may obtain a copy of the License at 7 * 8 * http://www.apache.org/licenses/LICENSE-2.0 9 * 10 * Unless required by applicable law or agreed to in writing, software 11 * distributed under the License is distributed on an "AS IS" BASIS, 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 13 * See the License for the specific language governing permissions and 14 * limitations under the License. 15 */ 16 17 #ifndef ANDROID_SENSOR_FUSION_H 18 #define ANDROID_SENSOR_FUSION_H 19 20 #include <stdint.h> 21 #include <sys/types.h> 22 23 #include <utils/SortedVector.h> 24 #include <utils/Singleton.h> 25 #include <utils/String8.h> 26 27 #include <gui/Sensor.h> 28 29 #include "Fusion.h" 30 31 // --------------------------------------------------------------------------- 32 33 namespace android { 34 // --------------------------------------------------------------------------- 35 36 class SensorDevice; 37 38 class SensorFusion : public Singleton<SensorFusion> { 39 friend class Singleton<SensorFusion>; 40 static const nsecs_t DEFAULT_EVENTS_PERIOD = 200000000; // 5 Hz 41 42 SensorDevice& mSensorDevice; 43 Sensor mAcc; 44 Sensor mMag; 45 Sensor mGyro; 46 Fusion mFusion; 47 bool mEnabled; 48 float mEstimatedGyroRate; 49 nsecs_t mTargetDelayNs; 50 nsecs_t mGyroTime; 51 vec4_t mAttitude; 52 SortedVector<void*> mClients; 53 54 SensorFusion(); 55 56 public: 57 void process(const sensors_event_t& event); 58 59 bool isEnabled() const { return mEnabled; } 60 bool hasEstimate() const { return mFusion.hasEstimate(); } 61 mat33_t getRotationMatrix() const { return mFusion.getRotationMatrix(); } 62 vec4_t getAttitude() const { return mAttitude; } 63 vec3_t getGyroBias() const { return mFusion.getBias(); } 64 float getEstimatedRate() const { return mEstimatedGyroRate; } 65 66 status_t activate(void* ident, bool enabled); 67 status_t setDelay(void* ident, int64_t ns); 68 69 float getPowerUsage() const; 70 int32_t getMinDelay() const; 71 72 void dump(String8& result); 73 }; 74 75 76 // --------------------------------------------------------------------------- 77 }; // namespace android 78 79 #endif // ANDROID_SENSOR_FUSION_H 80