Werkcollege opgave 23 september BMT K9
Dependencies: Encoder HIDScope MODSERIAL mbed QEI biquadFilter
main.cpp@12:0a079e86348e, 2015-10-07 (annotated)
- Committer:
- bscheltinga
- Date:
- Wed Oct 07 13:22:27 2015 +0000
- Revision:
- 12:0a079e86348e
- Parent:
- 11:73817c9df1e5
- Child:
- 13:04e10692e239
*EMG_Filter via groep 1 opgeschoond. Nog geen void functies;
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
bscheltinga | 0:fe3896c6eeb0 | 1 | #include "mbed.h" |
bscheltinga | 12:0a079e86348e | 2 | #include "HIDScope.h" |
bscheltinga | 0:fe3896c6eeb0 | 3 | #include "MODSERIAL.h" |
bscheltinga | 0:fe3896c6eeb0 | 4 | |
bscheltinga | 12:0a079e86348e | 5 | //Define objects |
bscheltinga | 12:0a079e86348e | 6 | AnalogIn emgB(PTB0); //Analog input left |
bscheltinga | 12:0a079e86348e | 7 | AnalogIn emgT(PTB1); //Analog input right |
bscheltinga | 4:96e47998d495 | 8 | |
bscheltinga | 12:0a079e86348e | 9 | float filtered_emgB; |
bscheltinga | 12:0a079e86348e | 10 | float filtered_emgT; |
bscheltinga | 12:0a079e86348e | 11 | float MeanT2, MeanB1, MeanB2, MeanB3; |
bscheltinga | 12:0a079e86348e | 12 | 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; |
bscheltinga | 12:0a079e86348e | 13 | float B0, B1, B2, B3, B4, B5, B6, B7, B8, B9, MOVAVG_B; |
bscheltinga | 12:0a079e86348e | 14 | float T0, T1, T2, T3, T4, T5, T6, T7, T8, T9, MOVAVG_T; |
bscheltinga | 12:0a079e86348e | 15 | float drempelwaardeB1, drempelwaardeB2, drempelwaardeB3, drempelwaardeT1, drempelwaardeT2; //denk niet nodig voor puur filter |
bscheltinga | 11:73817c9df1e5 | 16 | |
bscheltinga | 12:0a079e86348e | 17 | MODSERIAL pc(USBTX,USBRX); //activeren voor Putty |
bscheltinga | 0:fe3896c6eeb0 | 18 | |
bscheltinga | 12:0a079e86348e | 19 | HIDScope scope(4); // 4 channels in Hidscope |
bscheltinga | 11:73817c9df1e5 | 20 | |
bscheltinga | 12:0a079e86348e | 21 | arm_biquad_casd_df1_inst_f32 lowpass; |
bscheltinga | 12:0a079e86348e | 22 | //constants for 50Hz lowpass |
bscheltinga | 12:0a079e86348e | 23 | float lowpass_const[] = {0.2928920553, 0.5857841107, 0.2928920554, -0, -0.17156822136};//{a0 a1 a2 -b1 -b2} van online calculator |
bscheltinga | 12:0a079e86348e | 24 | //state values |
bscheltinga | 12:0a079e86348e | 25 | float lowpass_states[4]; |
bscheltinga | 12:0a079e86348e | 26 | |
bscheltinga | 12:0a079e86348e | 27 | arm_biquad_casd_df1_inst_f32 highpass; |
bscheltinga | 12:0a079e86348e | 28 | //constants for 10Hz highpass |
bscheltinga | 12:0a079e86348e | 29 | float highpass_const[] = {0.8005910267, -1.6011820533, 0.8005910267, 1.5610153913, -0.6413487154};//{a0 a1 a2 -b1 -b2} |
bscheltinga | 12:0a079e86348e | 30 | //state values |
bscheltinga | 12:0a079e86348e | 31 | float highpass_states[4]; |