1 files changed, 82 insertions, 0 deletions
diff --git a/LibOVR/Src/OVR_SensorCalibration.h b/LibOVR/Src/OVR_SensorCalibration.h
new file mode 100644
index 0000000..62883d2
--- /dev/null
+++ b/LibOVR/Src/OVR_SensorCalibration.h
@@ -0,0 +1,82 @@
+/************************************************************************************
+
+Filename    :   OVR_SensorCalibration.h
+Content     :   Calibration data implementation for the IMU messages 
+Created     :   January 28, 2014
+Authors     :   Max Katsev
+
+Copyright   :   Copyright 2014 Oculus VR, Inc. All Rights reserved.
+
+Licensed under the Oculus VR Rift SDK License Version 3.1 (the "License"); 
+you may not use the Oculus VR Rift SDK except in compliance with the License, 
+which is provided at the time of installation or download, or which 
+otherwise accompanies this software in either electronic or hard copy form.
+
+You may obtain a copy of the License at
+
+http://www.oculusvr.com/licenses/LICENSE-3.1 
+
+Unless required by applicable law or agreed to in writing, the Oculus VR SDK 
+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.
+
+*************************************************************************************/
+
+#ifndef OVR_SensorCalibration_h
+#define OVR_SensorCalibration_h
+
+#include "OVR_Device.h"
+#include "OVR_SensorFilter.h"
+
+namespace OVR {
+
+class OffsetInterpolator
+{
+public:
+    void Initialize(Array<Array<TemperatureReport> > const& temperatureReports, int coord);
+    double GetOffset(double targetTemperature, double autoTemperature, double autoValue);
+
+    Array<double> Temperatures;
+    Array<double> Values;
+};
+
+class SensorCalibration : public NewOverrideBase
+{
+public:
+    SensorCalibration(SensorDevice* pSensor);
+
+    // Load data from the HW and perform the necessary preprocessing
+    void Initialize();
+    // Apply the calibration
+    void Apply(MessageBodyFrame& msg);
+    // Is mag calibration available?
+    bool IsMagCalibrated() { return MagCalibrated; }
+
+protected:
+    void StoreAutoOffset();
+    void AutocalibrateGyro(MessageBodyFrame const& msg);
+
+	void DebugPrintLocalTemperatureTable();
+	void DebugClearHeadsetTemperatureReports();
+
+    SensorDevice* pSensor;
+
+    // Factory calibration data
+    bool MagCalibrated;
+    Matrix4f AccelMatrix, GyroMatrix, MagMatrix;
+    Vector3f AccelOffset;
+    
+    // Temperature based data
+    Array<Array<TemperatureReport> > TemperatureReports;
+    OffsetInterpolator Interpolators[3];
+
+    // Autocalibration data
+    SensorFilterf GyroFilter;
+    Vector3f GyroAutoOffset;
+    float GyroAutoTemperature;
+};
+
+} // namespace OVR
+#endif //OVR_SensorCalibration_h