Revision 4:c8ec56d87a5b, committed 2014-10-09

Comitter:

Daanmk

Date:

Thu Oct 09 13:29:37 2014 +0000

Parent:

3:9d5879b64f3c

Child:

5:b96b7b8facbf

Child:

10:1efe8b0cddd0

Commit message:

werkend NOTCH en HIGHPASS

Changed in this revision

--- a/main.cpp	Thu Oct 09 13:22:25 2014 +0000
+++ b/main.cpp	Thu Oct 09 13:29:37 2014 +0000
@@ -12,23 +12,23 @@
 #include "mbed.h"
 #include "HIDScope.h"
 #include "arm_math.h"
-
+ 
 //Define objects
 AnalogIn    emg0(PTB0); //Biceps
 AnalogIn    emg1(PTB1); //Triceps
 HIDScope scope(2);
-
-arm_biquad_casd_df1_inst_f32 lowpass;
-//constants for 5Hz lowpass
-float lowpass_const[] = {0.02008337 , 0.04016673 , 0.02008337 , 1.56101808 , -0.64135154};
+ 
+arm_biquad_casd_df1_inst_f32 notch;
+//constants for 50Hz notch
+float notch_const[] = {0.5857841106784856, -1.3007020142696517e-16, 0.5857841106784856, -1.3007020142696517e-16, 0.17156822135697122};
 //state values
-float lowpass_states[4];
+float notch_states[4];
 arm_biquad_casd_df1_inst_f32 highpass;
 //constants for 5Hz highpass
 float highpass_const[] = {0.8948577513857248, -1.7897155027714495, 0.8948577513857248, 0.8008009266036016};
 //state values
 float highpass_states[4];
-
+ 
 void looper()
 {
     /*variable to store value in*/    
@@ -38,24 +38,24 @@
     /*put raw emg value both in red and in emg_value*/
     emg_value = emg0.read_u16(); // read direct ADC result, converted to 16 bit integer (0..2^16 = 0..65536 = 0..3.3V)
     emg_value_f32 = emg0.read();
-
+ 
     //process emg
     arm_biquad_cascade_df1_f32(&highpass, &emg_value_f32, &filtered_emg, 1 );
     filtered_emg = fabs(filtered_emg);
-    arm_biquad_cascade_df1_f32(&lowpass, &filtered_emg, &filtered_emg, 1 );
+    arm_biquad_cascade_df1_f32(&notch, &filtered_emg, &filtered_emg, 1 );
     
     /*send value to PC. */
     scope.set(0,emg_value);     //uint value
     scope.set(1,filtered_emg);  //processed float
     scope.send();
-
+ 
 }
-
+ 
 int main()
 {
     Ticker log_timer;
    //set up filters. Use external array for constants
-    arm_biquad_cascade_df1_init_f32(&lowpass,1 , lowpass_const, lowpass_states);
+    arm_biquad_cascade_df1_init_f32(&notch,1 , notch_const, notch_states);
     arm_biquad_cascade_df1_init_f32(&highpass,1 ,highpass_const,highpass_states);
     
     log_timer.attach(looper, 0.005);