Werkcollege opgave 23 september BMT K9
Dependencies: Encoder HIDScope MODSERIAL mbed QEI biquadFilter
Diff: main.cpp
- Revision:
- 13:04e10692e239
- Parent:
- 12:0a079e86348e
- Child:
- 14:57d38789bff2
--- a/main.cpp Wed Oct 07 13:22:27 2015 +0000 +++ b/main.cpp Wed Oct 07 14:14:54 2015 +0000 @@ -1,31 +1,33 @@ #include "mbed.h" #include "HIDScope.h" #include "MODSERIAL.h" +#include "biquadFilter.h" //Filter direct form II //Define objects AnalogIn emgB(PTB0); //Analog input left AnalogIn emgT(PTB1); //Analog input right -float filtered_emgB; -float filtered_emgT; -float MeanT2, MeanB1, MeanB2, MeanB3; -float filtered_emgT10_C, filtered_emgT11_C, filtered_emgT12_C, filtered_emgT13_C, filtered_emgT14_C, filtered_emgT15_C, filtered_emgT16_C, filtered_emgT17_C, filtered_emgT18_C, filtered_emgT19_C, filtered_emgT110_C, filtered_emgT111_C, filtered_emgT112_C, filtered_emgT113_C, filtered_emgT114_C, filtered_emgT115_C, filtered_emgT116_C, filtered_emgT117_C, filtered_emgT118_C, filtered_emgT119_C; -float B0, B1, B2, B3, B4, B5, B6, B7, B8, B9, MOVAVG_B; -float T0, T1, T2, T3, T4, T5, T6, T7, T8, T9, MOVAVG_T; -float drempelwaardeB1, drempelwaardeB2, drempelwaardeB3, drempelwaardeT1, drempelwaardeT2; //denk niet nodig voor puur filter +Ticker looptimer; + +biquadFilter Lowpassfilter; +biquadFilter Highpassfilter; -MODSERIAL pc(USBTX,USBRX); //activeren voor Putty +output = Lowpassfilter.step(input); -HIDScope scope(4); // 4 channels in Hidscope +void setlooptimerflag(void) +{ + looptimerflag = 1; +} -arm_biquad_casd_df1_inst_f32 lowpass; -//constants for 50Hz lowpass -float lowpass_const[] = {0.2928920553, 0.5857841107, 0.2928920554, -0, -0.17156822136};//{a0 a1 a2 -b1 -b2} van online calculator -//state values -float lowpass_states[4]; +int main() +{ + looptimer.attach(setlooptimerflag,0.01); + while(1) { -arm_biquad_casd_df1_inst_f32 highpass; -//constants for 10Hz highpass -float highpass_const[] = {0.8005910267, -1.6011820533, 0.8005910267, 1.5610153913, -0.6413487154};//{a0 a1 a2 -b1 -b2} -//state values -float highpass_states[4]; + { + while(looptimerflag !=1) { + loopterimerflag 0; + output = Lowpassfilter.step(input); + } + } + } \ No newline at end of file