BETA_A

Dependencies:   DataPool MD_PID mbed

Revision:
5:93abe8105833
Parent:
0:b8fa7a019f5d
Child:
6:22fed7630a18
--- a/2017_3_h/2017_3_h.cpp	Wed Aug 30 05:21:27 2017 +0000
+++ b/2017_3_h/2017_3_h.cpp	Thu Aug 31 00:23:44 2017 +0000
@@ -29,7 +29,7 @@
     double speed[3];
 
     dere = atan2(arg_y, arg_x);
-    sp = sqrt(pow(arg_x, 2.0) + pow(arg_y, 2.0));
+    sp = pow(arg_x * arg_x + arg_y * arg_y, 0.60);
 
     speed[0] = cos(dere) * sp;   // vx
     speed[1] = sin(dere) * sp;   // vy