Diff: Accelerometre.cpp

Revision:

4:ab14f0e33f2b

Parent:

3:56cd9dff3b5f

Child:

5:70db90b673b9

--- a/Accelerometre.cpp	Mon Sep 04 22:39:02 2017 +0000
+++ b/Accelerometre.cpp	Mon Sep 04 23:39:44 2017 +0000
@@ -3,16 +3,30 @@
 
 
 Accelerometre::Accelerometre():i2c(p9,p10),pc(USBTX, USBRX),acc(p9, p10, 40000){
+    
+   acc.setBitDepth(MMA8452::BIT_DEPTH_12);
+   acc.setDynamicRange(MMA8452::DYNAMIC_RANGE_4G);
+   acc.setDataRate(MMA8452::RATE_100);
+   
     }
     
-int Accelerometre::readxyzAngle(double *x, double *y, double *z){
-    
-    acc.readXYZGravity(x,y,z);
+void Accelerometre::readxyzAngle(double *Angle){
+    double x=0, y=0, z=0;
+    acc.readXYZGravity(&x,&y,&z);
+    *Angle = AngleCalculation(z);
     
 }
     
+double Accelerometre::AngleCalculation(double  ZValue){
+    if(ZValue>1){
+        ZValue = 1;
+    }
+    double  angle =std::acos(ZValue)
+    return angle*180* PI;
     
     
+}
+    
     
 //int Accelerometre::readSingleByte(int regis){
 //    int c;