remove the initial glitch simplefoc#111 and simplefoc#110

Author: askuric

src/common/base_classes/Sensor.cpp

@@ -19,7 +19,7 @@ float Sensor::getVelocity() {
     // calculate sample time
     float Ts = (angle_prev_ts - vel_angle_prev_ts)*1e-6;
     // quick fix for strange cases (micros overflow)
-    if(Ts <= 0 || Ts > 0.5f) Ts = 1e-3f;
+    if(Ts <= 0) Ts = 1e-3f;
     // velocity calculation
     float vel = ( (float)(full_rotations - vel_full_rotations)*_2PI + (angle_prev - vel_angle_prev) ) / Ts;    
     // save variables for future pass