zhaw_st16b_pes2_10 / Mbed 2 deprecated PES_Official-US

a

Dependencies:   Servo ServoArm mbed

Fork of PES_Official-TestF by zhaw_st16b_pes2_10

Diff: Sources/USsensor.cpp

Revision:
18:a158713a0049
Parent:
17:4e1be70bdedb
--- a/Sources/USsensor.cpp	Thu May 18 14:27:09 2017 +0000
+++ b/Sources/USsensor.cpp	Fri May 19 06:40:33 2017 +0000
@@ -21,8 +21,9 @@
         float dist = Usensor->get_dist_cm();
         static float distFiltered = dist;
         
-        distFiltered = 0.05f * distFiltered + 0.95f * dist;
-        return distFiltered / 100;
+        //distFiltered = 0.05f * distFiltered + 0.95f * dist;
+        printf("\n\rmeas= %.3f",distFiltered/100);
+        return dist / 100;
         //return dist/100.0f;
     }
     else{