Werkcollege opgave 23 september BMT K9

Dependencies:   Encoder HIDScope MODSERIAL mbed QEI biquadFilter

main.cpp

Committer:
bscheltinga
Date:
2015-10-07
Revision:
12:0a079e86348e
Parent:
11:73817c9df1e5
Child:
13:04e10692e239

File content as of revision 12:0a079e86348e:

#include "mbed.h"
#include "HIDScope.h"
#include "MODSERIAL.h"

//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

MODSERIAL pc(USBTX,USBRX); //activeren voor Putty

HIDScope scope(4); // 4 channels in Hidscope

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];

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];