Diff: T_motor.cpp

Revision:

3:a3be8ae9fed1

Parent:

2:f82a7c0b697f

Child:

4:8c674d9893ad

--- a/T_motor.cpp	Mon Aug 21 00:56:29 2017 +0000
+++ b/T_motor.cpp	Mon Aug 21 04:31:39 2017 +0000
@@ -27,22 +27,20 @@
 
 T_motor& T_motor::operator=(float fval)// -1 <= fval <= 1
 {
-    fval = sqrt(fval);
     if(fabs(fval) < 0.1f)free();
     else {
-        if(fval < 0) run(1,char(-1*fval*255));
-        else if(fval > 0) run(0,char(fval*255));
+        if(fval < 0) run(1,char(-1*sqrt(fval)*255));
+        else if(fval > 0) run(0,char(sqrt(fval)*255));
     }
     return *this;
 }
 
 void T_motor::control(float fval)//copy from operator
 {
-    fval = sqrt(fval);
     if(fabs(fval) < 0.1f)free();
     else {
-        if(fval < 0) run(1,char(-1*fval*255));
-        else if(fval > 0) run(0,char(fval*255));
+        if(fval < 0) run(1,char(-1*sqrt(fval)*255));
+        else if(fval > 0) run(0,char(sqrt(fval)*255));
     }
 }