![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
Facking kut filter werkt EINDELIJK !311!!111!!1!!!!!!!!!!!!!!!!!!!
Dependencies: HIDScope MODSERIAL Matrix QEI biquadFilter mbed
Fork of Turning_Motor_V6 by
Revision 9:355babe55589, committed 2018-10-31
- 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 |
--- 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(); }