Diff: main.cpp

Revision:

19:992f183385e8

Parent:

18:171cb8d2f243

Child:

20:107380f7eeb9

--- a/main.cpp	Thu Aug 31 17:54:54 2017 +0000
+++ b/main.cpp	Thu Aug 31 19:39:48 2017 +0000
@@ -17,34 +17,26 @@
          x = acc.getAccX() ;
          y = acc.getAccY() ;
          z = acc.getAccZ() ;
-        // printf("X[%.2f] Y[%.2f] Z[%.2f]\n",x, y, z) ;
+         printf("X[%.3f] Y[%.3f] Z[%.3f]\n",x, y, z) ;
          wait(0.1);
 
-        int X = x * 100;
-        int Y = y * 100;
-        int Z = z * 100;
+        int X = x * 1000;
+        int Y = y * 1000;
+        int Z = z * 1000;
 
-        float angle = 1-(((2*X*X+2*Y*Y)/(X*X+Y*Y+Z*Z)));
+        int angle = (1000-(((2*X*X+2*Y*Y)*1000/(X*X+Y*Y+Z*Z))));
         
-        pc.printf("avant acos = %f", angle);
+        pc.printf("avant acos = %d", angle);
         //float resultat = ((3.14/2.0) -( angle + (angle *angle * angle)/6.0 + (3*angle*angle*angle*angle*angle)/40.0))/2;
+        float angleAcos = angle/1000.0;
         
-        int resultat = acos(angle)*5;
+        int resultat = 500*acos((angleAcos));
         pc.printf("valeur rad new= %d", resultat);
-        int degree = resultat * 18000/314;
+        int degree = resultat * 18000/314000;
         pc.printf("valeur deg new = %d", degree);
         //degree = degree * 10;
         int degreInt = degree;
         pc.printf("valeur deg new = %d", degreInt);
-        
-        
-        float resultat2 = (3.14/2.0) -( z + (z *z * z)/6.0 + (3*z*z*z*z*z)/40.0);
-        pc.printf("valeur rad old = %f", resultat2);
-        float degree2 = resultat2 * 18000.0/314.0;
-        pc.printf("valeur deg old = %f", degree2);
-        degree2 = degree2 * 10;
-        int degreInt2 = (int)degree;
-        pc.printf("valeur deg old = %d", degreInt2);
          
         int rep;
          // extracting digits