BETA_A
Dependencies: DataPool MD_PID mbed
Diff: 2017_3_h/2017_3_h.cpp
- 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