Combination code of movement and emg code with small changes for 2 motors.
Dependencies: HIDScope MODSERIAL QEI biquadFilter mbed
Fork of EMG_converter_code by
Diff: main.cpp
- Revision:
- 2:83659da3e5fe
- Parent:
- 1:9913e3886643
- Child:
- 3:a69f041108d4
diff -r 9913e3886643 -r 83659da3e5fe main.cpp --- a/main.cpp Fri Oct 23 08:36:59 2015 +0000 +++ b/main.cpp Mon Oct 26 13:22:32 2015 +0000 @@ -6,6 +6,8 @@ AnalogIn emg(A0); //Analog of EMG input Ticker sample_timer; HIDScope scope(2); // Instantize a 2-channel HIDScope object +DigitalIn button1(PTA4);//test button for starting motor 1 +DigitalOut led1(LED_RED); /*The biquad filters required to transform the EMG signal into an usable signal*/ biquadFilter filterhigh1(-1.1430, 0.4128, 0.6389, -1.2779, 0.6389); biquadFilter filterlow1(1.9556, 0.9565, 0.9780, 1.9561, 0.9780); @@ -17,38 +19,43 @@ double signalpart3; double signalpart4; double signalfinal; - +double onoffsignal; +double maxcal=1; /* */ -void filter() -{ +void filter(){ emg_value = emg.read();//read the emg value from the elektrodes signalpart1 = filterhigh1.step(emg_value);//Highpass filter for removing offset and artifacts signalpart2 = abs(signalpart1);//rectify the filtered signal signalpart3 = filterlow1.step(signalpart2);//low pass filter to envelope the emg signalpart4 = notch.step(signalpart3);//notch filter to remove 50Hz signal signalfinal = filterlow2.step(signalpart4);//2nd low pass filter to envelope the emg + onoffsignal=signalfinal/maxcal;//divide the emg signal by the max EMG to calibrate the signal per person scope.set(0,emg_value);//set emg signal to scope in channel 1 - scope.set(1,signalfinal);//set filtered signal to scope in channel 2 + scope.set(1,onoffsignal);//set filtered signal to scope in channel 2 scope.send();//send the signals to the scope } - +double normalcal(){ + double signalmeasure =emg.read(); + if (signalmeasure > maxcal){ + signalmeasure = maxcal; + } + return maxcal; +} +const int button_pressed = 0; +bool caldone =0; int main() { - int caldone=0; - double maxValue = 0;//define the max value to start with - while(1){ - while(PTC6){//as long as the button is pressed record the emg signal - double signalmeasure=emg.read();//read the emg values to check for max - if(signalmeasure > maxValue){ - maxValue = signalmeasure; + + if(button1.read() == button_pressed){//as long as the button is pressed record the emg signal + led1.write(!led1.read()); + } /* double signalmeasure=emg.read();//read the emg values to check for max + if(signalmeasure > maxcal){ + maxcal = signalmeasure; } - caldone=1; - } - double maxcal=maxValue; + caldone=1; */ + if(caldone==1){ sample_timer.attach(&filter, 0.002);//continously execute the EMG reader and filter - double onoffsignal=signalfinal/maxcal;//divide the emg signal by the max EMG to calibrate the signal per person -} -} + } } \ No newline at end of file