to send emg signal to motor with test programm
Dependencies: HIDScope biquadFilter mbed
Fork of EMGvoorjan by
main.cpp
- Committer:
- Roytsg
- Date:
- 2017-10-20
- Revision:
- 22:a85b568a83e5
- Parent:
- 21:77998ce2c0dd
File content as of revision 22:a85b568a83e5:
#include "mbed.h" #include "HIDScope.h" #include "BiQuad.h" //Define objects AnalogIn emg0( A0 ); AnalogIn emg1( A1 ); Ticker sample_timer; HIDScope scope( 2 ); DigitalOut led(LED1); /** Sample function * this function samples the emg and sends it to HIDScope **/ void sample() { /* Set the sampled emg values in channel 0 (the first channel) and 1 (the second channel) in the 'HIDScope' instance named 'scope' */ scope.set(0, emg0.read() ); scope.set(1, emg1.read() ); /* Repeat the step above if required for more channels of required (channel 0 up to 5 = 6 channels) * Ensure that enough channels are available (HIDScope scope( 2 )) * Finally, send all channels to the PC at once */ scope.send(); /* To indicate that the function is working, the LED is toggled */ led = !led; } BiQuadChain bqc; BiQuad bq1( 0.6844323315947305,1.368864663189461, 0.6844323315947305,1.2243497755555954,0.5133795508233265); //lp BiQuad bq2( 0.8664196904854168, -1.7328393809708336, 0.8664196904854168, -1.7051848034569674, 0.7604939584846998); //hp BiQuad bq3( 0.7566897754116633, -1.2243497755555959, 0.7566897754116633, -1.2243497755555959, 0.5133795508233266); //notch Ticker emgSampleTicker; AnalogIn emg( A0 ); void emgSample() { double emgFiltered = bqc.step( emg.read() ); scope.set(0, emgFiltered ); scope.send(); } int main() { bqc.add( &bq1 ).add( &bq2 ).add( &bq3 ); emgSampleTicker.attach( &emgSample, 0.002 ); /**Attach the 'sample' function to the timer 'sample_timer'. * this ensures that 'sample' is executed every... 0.002 seconds = 500 Hz */ //sample_timer.attach(&sample, 0.01); /*empty loop, sample() is executed periodically*/ while(1) {} }