Werkcollege opgave 23 september BMT K9

Dependencies:   Encoder HIDScope MODSERIAL mbed QEI biquadFilter

main.cpp

Committer:
bscheltinga
Date:
2015-10-07
Revision:
15:7870f7912904
Parent:
14:57d38789bff2
Child:
16:ca457fa8257f
Child:
17:a69df9645074

File content as of revision 15:7870f7912904:

#include "mbed.h"
#include "HIDScope.h"
#include "MODSERIAL.h"
#include "biquadFilter.h" //Filter direct form II

//Define inputs
AnalogIn    emgL(PTB0); //Analog input left arm
AnalogIn    emgR(PTB1); //Analog input right arm

//Define constants
float emgL_L;

Ticker looptimer;
volatile bool looptimerflag;

const float a1 = 0;
const float a2 = 0.17156822136;
const float b0 = 0.2928920553;
const float b1 = 0.5857841107;
const float b2 = 0.2928920554; // Waarde van biquads via groep 1 2014
biquadFilter Lowpassfilter (a1, a2, b0, b1, b2);

HIDScope scope(1); // 1 HIDScope kanaal

void setlooptimerflag(void)
{
    looptimerflag = true;
}

int main()
{
    looptimer.attach(setlooptimerflag,0.01);
    while(true) {

        while (looptimerflag !=true) {
            looptimerflag = false;
            emgL_L = Lowpassfilter.step(emgL); //emgL_L Linker bicep met lowpass filter
        }
        scope.set(0,emgL_L);
        scope.send();
    }
}