Kang mingyo / motor_sn7544

sn7544

Diff: motor.cpp

Revision:
7:42c478f9a1fe
Parent:
6:366ec55e64fe
Child:
8:4fa7fadc583d
--- a/motor.cpp	Wed Jul 10 04:08:29 2019 +0000
+++ b/motor.cpp	Wed Jul 10 04:30:47 2019 +0000
@@ -187,7 +187,7 @@
 }
 float MotorCtl::CalculateVelocity()
 {
-    return (DeltaCnt*1000.0)*3.14159265359*0.043/(float)(DeltaT*CntPerRev)
+    return getRPM()*3.14159265359*0.043/60;
 }