Richard Roos / Mbed 2 deprecated TotalControlEmg2

Total control sjoel robot

Dependencies:   HIDScope MODSERIAL QEI TextLCD mbed

main.cpp

Committer:
Bartvaart
Date:
2015-10-08
Revision:
14:371e0d505971
Parent:
13:b01231e0b743
Child:
15:c1a8f28d6583

File content as of revision 14:371e0d505971:

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

AnalogIn    emg(A0); //Analog input van emg kabels
HIDScope    scope(2); //3 scopes
Ticker      EMGticker;
MODSERIAL   pc(USBTX, USBRX);

//Sample frequentie
double Fs = 5; //Hz
double t = 1/ Fs; // voor EMGticker

double y = 0;
double ymean = 0;

void EMGfilter(){
    //uitlezen emg signaal
    double u = emg.read();
    Filterdesigns(u,y, ymean);
    pc.printf("%f \n",y);
    // Plotten in HIDscope
    //scope.set(0,u); //ongefilterde waarde naar scope 1
    //scope.set(1,y); //gefilterde waarde naar scope 2
    //scope.set(0,ymean); // gefilterde en gemiddelde waarde naar scope 3
    scope.send(); //stuur de waardes naar HIDscope
    }
    

int main(){
    EMGticker.attach(&EMGfilter, t); //500Hz
    while(1){}
    }