2nd try

Dependents:   cuboid_balance

Revision:
3:29602f4ade5c
Parent:
0:72b60c5271cc
diff -r dd5d116ace8f -r 29602f4ade5c DiffCounter.cpp
--- a/DiffCounter.cpp	Thu Mar 07 09:16:03 2019 +0000
+++ b/DiffCounter.cpp	Thu Feb 25 20:28:16 2021 +0000
@@ -16,7 +16,7 @@
     a = -(2.0*(double)T - (double)Ts)/(2.0*(double)T + (double)Ts);
     incPast = 0;
     vel = 0.0;
-    inc2rad = 2.0*pi/(4.0*6400.0);   // incr encoder with 6400inc/rev
+    inc2rad = 2.0*pi/(4000.0);   // incr encoder with 6400inc/rev
 }
 
 DiffCounter::~DiffCounter() {}