Facking kut filter werkt EINDELIJK !311!!111!!1!!!!!!!!!!!!!!!!!!!

Dependencies:   HIDScope MODSERIAL Matrix QEI biquadFilter mbed

Fork of Turning_Motor_V6 by Brighton de Jong

Files at this revision

API Documentation at this revision

Comitter:
Brighton_the_robot
Date:
Wed Oct 31 19:53:52 2018 +0000
Parent:
8:b6b09226a421
Commit message:
Inclusief filter

Changed in this revision

main.cpp Show annotated file Show diff for this revision Revisions of this file
diff -r b6b09226a421 -r 355babe55589 main.cpp
--- a/main.cpp	Wed Oct 31 13:56:41 2018 +0000
+++ b/main.cpp	Wed Oct 31 19:53:52 2018 +0000
@@ -48,10 +48,11 @@
 BiQuad BqHP2( 9.86760e-01, -1.97352e+00, 9.86760e-01, -1.97334e+00, 9.73695e-01 );
 BiQuad BqHP3( 9.86760e-01, -1.97352e+00, 9.86760e-01, -1.97334e+00, 9.73695e-01 );
 BiQuad BqHP4( 9.86760e-01, -1.97352e+00, 9.86760e-01, -1.97334e+00, 9.73695e-01 );
-BiQuad BqLP1( 8.76555e-05, 1.75311e-04, 8.76555e-05, -1.97334e+00, 9.73695e-01 );
-BiQuad BqLP2( 8.76555e-05, 1.75311e-04, 8.76555e-05, -1.97334e+00, 9.73695e-01 );
-BiQuad BqLP3( 8.76555e-05, 1.75311e-04, 8.76555e-05, -1.97334e+00, 9.73695e-01 );
-BiQuad BqLP4( 8.76555e-05, 1.75311e-04, 8.76555e-05, -1.97334e+00, 9.73695e-01 );
+
+BiQuad BqLP1( 3.91302e-05, 7.82604e-05, 3.91302e-05, -1.98223e+00, 9.82385e-01 );
+BiQuad BqLP2( 3.91302e-05, 7.82604e-05, 3.91302e-05, -1.98223e+00, 9.82385e-01 );
+BiQuad BqLP3( 3.91302e-05, 7.82604e-05, 3.91302e-05, -1.98223e+00, 9.82385e-01 );
+BiQuad BqLP4( 3.91302e-05, 7.82604e-05, 3.91302e-05, -1.98223e+00, 9.82385e-01 );
 
 volatile float Bicep_Right          = 0.0;
 volatile float Bicep_Left           = 0.0;
@@ -131,10 +132,10 @@
 void sample()
 {
     
-    scope.set(0, Filtered_Bi_R );
-    scope.set(1, Filtered_Bi_L );
-    scope.set(2, Filtered_Tri_R );
-    scope.set(3, Filtered_Tri_L );
+    scope.set(0, Filtered_Bi_R*10.0f );
+    scope.set(1, Filtered_Bi_L*10.0f );
+    scope.set(2, Filtered_Tri_R*10.0f );
+    scope.set(3, Filtered_Tri_L*10.0f );
   
     scope.send();
 }