team app1
/
HelloWorld
test
Fork of HelloWorld by
Diff: main.cpp
- Revision:
- 19:992f183385e8
- Parent:
- 18:171cb8d2f243
- Child:
- 20:107380f7eeb9
diff -r 171cb8d2f243 -r 992f183385e8 main.cpp --- 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