Remco Dasselaar / Mbed 2 deprecated TotalControlEmg2

Dependencies:   HIDScope MODSERIAL QEI TextLCD mbed

Fork of TotalControlEmg2 by Remco Dasselaar

Committer:
Bartvaart
Date:
Wed Oct 07 13:48:19 2015 +0000
Revision:
9:1655d67d8a53
Parent:
8:a8c66bd140f8
Child:
10:897db0bdb2fe
werkt niet met gemiddelde;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Bartvaart 0:557b1ff83a8a 1 #include "mbed.h"
Bartvaart 7:040591b3f019 2 #include "HIDScope.h"
Bartvaart 5:b400209df739 3 #include "Filterdesigns.h"
Bartvaart 9:1655d67d8a53 4 #include "Meanvalue.h"
Bartvaart 0:557b1ff83a8a 5
Bartvaart 7:040591b3f019 6 AnalogIn emg(A0); //Analog input van emg kabels
Bartvaart 7:040591b3f019 7 HIDScope scope(3); //2 scopes
Bartvaart 0:557b1ff83a8a 8 Ticker EMGticker;
Bartvaart 0:557b1ff83a8a 9
Bartvaart 0:557b1ff83a8a 10 //Sample frequentie
Bartvaart 1:98be4152a539 11 double Fs = 500; //Hz
Bartvaart 1:98be4152a539 12 double t = 1/ Fs; // voor EMGticker
Bartvaart 5:b400209df739 13
Bartvaart 9:1655d67d8a53 14 // gemidelde waarde
Bartvaart 9:1655d67d8a53 15 double sum = 0;
Bartvaart 7:040591b3f019 16 double ymean = 0;
Bartvaart 9:1655d67d8a53 17 int a = 0;
Bartvaart 9:1655d67d8a53 18 int delay = 40;
Bartvaart 9:1655d67d8a53 19
Bartvaart 9:1655d67d8a53 20 double y=0;
Bartvaart 9:1655d67d8a53 21
Bartvaart 7:040591b3f019 22
Bartvaart 6:8197f9446daf 23 void EMGfilter(){
Bartvaart 7:040591b3f019 24 //uitlezen emg signaal
Bartvaart 7:040591b3f019 25 double u = emg.read();
Bartvaart 9:1655d67d8a53 26 Filterdesign1(u, y);
Bartvaart 9:1655d67d8a53 27 double ymean = Meanvalue(y, sum, ymean, a, delay);
Bartvaart 7:040591b3f019 28
Bartvaart 7:040591b3f019 29 // Plotten in HIDscope
Bartvaart 7:040591b3f019 30 scope.set(0,u); //ongefilterde waarde naar scope 1
Bartvaart 7:040591b3f019 31 scope.set(1,y); //gefilterde waarde naar scope 2
Bartvaart 7:040591b3f019 32 scope.set(2,ymean); // gefilterde en gemiddelde waarde naar scope 3
Bartvaart 7:040591b3f019 33 scope.send(); //stuur de waardes naar HIDscope
Bartvaart 6:8197f9446daf 34 }
Bartvaart 0:557b1ff83a8a 35
Bartvaart 0:557b1ff83a8a 36
Bartvaart 0:557b1ff83a8a 37 int main(){
Bartvaart 1:98be4152a539 38 EMGticker.attach(&EMGfilter, t); //500Hz
Bartvaart 0:557b1ff83a8a 39 while(1){}
Bartvaart 0:557b1ff83a8a 40 }
Bartvaart 0:557b1ff83a8a 41