Guo Yanhong / Hobbyking_Cheetah_Compact_DRV8323

ares

Dependencies:   mbed-dev-f303 FastPWM3

Diff: PositionSensor/PositionSensor.cpp

Revision:
34:51647c6c500d
Parent:
28:8c7e29f719c5
Child:
35:69b24894c11d
--- a/PositionSensor/PositionSensor.cpp	Wed Aug 30 18:10:27 2017 +0000
+++ b/PositionSensor/PositionSensor.cpp	Wed Nov 08 15:18:18 2017 +0000
@@ -72,6 +72,7 @@
     velVec[0] = vel;
     MechVelocity =  sum/(float)n;
     ElecVelocity = MechVelocity*_ppairs;
+    ElecVelocityFilt = 0.99f*ElecVelocityFilt + 0.01f*ElecVelocity;
     }
 
 int PositionSensorAM5147::GetRawPosition(){