1 files changed, 127 insertions, 0 deletions
diff --git a/sensors-service/src/acceleration.c b/sensors-service/src/acceleration.c
new file mode 100644
index 0000000..2dec916
--- /dev/null
+++ b/sensors-service/src/acceleration.c
@@ -0,0 +1,127 @@
+/**************************************************************************
+* @licence app begin@
+*
+* SPDX-License-Identifier: MPL-2.0
+*
+* \ingroup SensorsService
+* \author Marco Residori <marco.residori@xse.de>
+*
+* \copyright Copyright (C) 2013, XS Embedded GmbH
+* 
+* \license
+* This Source Code Form is subject to the terms of the
+* Mozilla Public License, v. 2.0. If a copy of the MPL was not distributed with
+* this file, You can obtain one at http://mozilla.org/MPL/2.0/.
+*
+* @licence end@
+**************************************************************************/
+
+#include "globals.h"
+#include "acceleration.h"
+#include "sns-meta-data.h"
+
+AccelerationCallback cbAcceleration = 0;
+TAccelerationData gAccelerationData;
+TAccelerationConfiguration gAccelerationConfiguration;
+
+bool snsAccelerationInit()
+{
+    cbAcceleration = 0;
+
+    //example accelerometer configuration for a 3-axis accelerometer
+    gAccelerationConfiguration.dist2RefPointX = 0;
+    gAccelerationConfiguration.dist2RefPointY = 0;
+    gAccelerationConfiguration.dist2RefPointZ = 0;    
+    gAccelerationConfiguration.angleYaw = 0;
+    gAccelerationConfiguration.anglePitch = 0;
+    gAccelerationConfiguration.angleRoll = 0;
+    gAccelerationConfiguration.sigmaX = 0;
+    gAccelerationConfiguration.sigmaY = 0;
+    gAccelerationConfiguration.sigmaZ = 0;
+    gAccelerationConfiguration.typeBits = 
+        ACCELERATION_X_PROVIDED |
+        ACCELERATION_Y_PROVIDED |
+        ACCELERATION_Z_PROVIDED;
+    gAccelerationConfiguration.validityBits = 
+      ACCELERATION_CONFIG_ANGLEYAW_VALID | 
+      ACCELERATION_CONFIG_ANGLEPITCH_VALID |
+      ACCELERATION_CONFIG_ANGLEROLL_VALID |
+      ACCELERATION_CONFIG_TYPE_VALID;
+
+    return true;
+}
+
+bool snsAccelerationDestroy()
+{
+    cbAcceleration = 0;
+
+    return true;
+}
+
+bool snsAccelerationGetAccelerationData(TAccelerationData * accelerationData)
+{
+    if(!accelerationData)
+    {
+    	return false;
+    }
+
+    pthread_mutex_lock(&mutexData);
+    *accelerationData = gAccelerationData;
+    pthread_mutex_unlock(&mutexData);
+
+    return true;
+}
+
+bool snsAccelerationRegisterCallback(AccelerationCallback callback)
+{
+    //printf("snsAccelerationRegisterCallback\n");
+    if(cbAcceleration != 0) 
+    {
+        return false;
+    }
+
+    pthread_mutex_lock(&mutexCb);
+    cbAcceleration = callback;
+    pthread_mutex_unlock(&mutexCb);
+
+    return true;
+}
+
+bool snsAccelerationDeregisterCallback(AccelerationCallback callback)
+{
+    //printf("snsAccelerationDeregisterCallback\n");
+    if(cbAcceleration == callback && callback != 0)
+    {
+        pthread_mutex_lock(&mutexCb);
+        cbAcceleration = 0;
+        pthread_mutex_unlock(&mutexCb);
+
+        return true;
+    }
+
+    return false;
+}
+
+bool snsAccelerationGetMetaData(TSensorMetaData *data)
+{
+    if(data != 0) 
+    {
+        return false;
+    }
+    
+    pthread_mutex_lock(&mutexData);
+    *data = gSensorsMetaData[3];
+    pthread_mutex_unlock(&mutexData);
+
+    return true;
+}
+
+bool snsAccelerationGetAccelerationConfiguration(TAccelerationConfiguration* config)
+{
+    *config = gAccelerationConfiguration;
+    return true;
+}
+
+
+
+