team app1
/
HelloWorld
test
Fork of HelloWorld by
Diff: main.cpp
- Revision:
- 18:171cb8d2f243
- Parent:
- 17:c463c5a434ec
- Child:
- 19:992f183385e8
diff -r c463c5a434ec -r 171cb8d2f243 main.cpp --- a/main.cpp Thu Aug 31 17:37:12 2017 +0000 +++ b/main.cpp Thu Aug 31 17:54:54 2017 +0000 @@ -20,15 +20,21 @@ // printf("X[%.2f] Y[%.2f] Z[%.2f]\n",x, y, z) ; wait(0.1); - float angle = 1-(((2*x*x+2*y*y)/(x*x+y*y+z*z))); + int X = x * 100; + int Y = y * 100; + int Z = z * 100; + + float angle = 1-(((2*X*X+2*Y*Y)/(X*X+Y*Y+Z*Z))); + pc.printf("avant acos = %f", angle); //float resultat = ((3.14/2.0) -( angle + (angle *angle * angle)/6.0 + (3*angle*angle*angle*angle*angle)/40.0))/2; - float resultat = acos(angle)/2.0; - pc.printf("valeur rad new= %f", resultat); - float degree = resultat * 18000.0/314.0; - pc.printf("valeur deg new = %f", degree); - degree = degree * 10; - int degreInt = (int)degree; + + int resultat = acos(angle)*5; + pc.printf("valeur rad new= %d", resultat); + int degree = resultat * 18000/314; + pc.printf("valeur deg new = %d", degree); + //degree = degree * 10; + int degreInt = degree; pc.printf("valeur deg new = %d", degreInt);