File content as of revision 23:dec549767006:

#include "mbed.h"
#include "HIDScope.h"
#include "BiQuad.h"

HIDScope scope( 2 );
Ticker sample_timer;

// Inputs EMG
AnalogIn emg0_in( A0 );
AnalogIn emg1_in( A1 );
AnalogIn emg2_in( A2 );

// Constants EMG
const double m1 = 0.5000;
const double m2 = -0.8090;
const double n0 = 0.5000;
const double n1 = -0.8090;
const double n2 = 0;
const double a1 = 0.9565;
const double a2 = -1.9131;
const double b0 = 0.9565;
const double b1 = -1.9112;
const double b2 = 0.9150;
const double c1 = 0.0675;
const double c2 = 0.1349;
const double d0 = 0.0675;
const double d1 = -1.1430;
const double d2 = 0.4128;

// Variables EMG
double notchFitler1 = 0;
double highpassFilter1 = 0;
double lowpassFilter1 = 0;
double notchFilter2 = 0;
double highpassFilter2 = 0;
double lowpassFilter2 = 0;

// BiQuad values
BiQuadChain notch;
BiQuad N1( m1, m2, n0, n1, n2);
BiQuad N2( m1, m2, n0, n1, n2);
BiQuad N3( m1, m2, n0, n1, n2);
BiQuadChain highpass;
BiQuad H1( a1, a2, b0, b1, b2);
BiQuad H2( a1, a2, b0, b1, b2);
BiQuad H3( a1, a2, b0, b1, b2);
BiQuadChain lowpass;
BiQuad L1( c1, c2, d0, d1, d2);
BiQuad L2( c1, c2, d0, d1, d2);
BiQuad L3( c1, c2, d0, d1, d2);

// Filter of the first EMG signal
void filter0()
{
    double emg0;
    double notch;
    double high;
    double absolute;
    double low;
    emg0 = emg0_in.read(); // Reading the EMG signal
    notch = N1.step(emg0); // Applying a notch filter over the EMG data
    high = H1.step(notch); // Applying a high pass filter
    absolute = fabs(high); // Rectifying the data
    low = L1.step(absolute); // Applying low pass filter
    
    scope.set(0,emg0);
    scope.set(1,low);
    scope.send(); 
}

// Filter of the second EMG signal
void filter1(){
    double emg1;
    double notch;
    double high;
    double absolute;
    double low;
    emg1 = emg1_in.read(); // Reading the EMG signal
    notch = N2.step(emg1); // Applying a notch filter over the EMG data
    high = H2.step(notch); // Applying a high pass filter
    absolute = fabs(high); // Rectifying the data
    low = L2.step(absolute); // Applying low pass filter
    
    //scope.set(3,emg1); 
    //scope.set(4,low);
    //scope.send(); 
}

// Filter of the third EMG signal
void filter2()
{
    double emg2;
    double notch;
    double high;
    double absolute;
    double low;
    emg2 = emg2_in.read(); // Reading the EMG signal
    notch = N3.step(emg2); // Applying a notch filter over the EMG data
    high = H3.step(notch); // Applying a high pass filter
    absolute = fabs(high); // Rectifying the data
    low = L3.step(absolute); // Applying low pass filter
    
    //scope.set(5,emg2);
    //scope.set(6,low);
    //scope.send(); 
}

// Combining the filters in one fuction
void filtered_emg()
{
    filter0();
    filter1();
    filter2();
}

int main() 
{  
    sample_timer.attach(&filter0, 0.002); //filter0 can be changed to signal 1 of 2

    while(1) {}
}