emg_mk
Dependencies: HIDScope MODSERIAL mbed-dsp mbed
Revision 10:9319e872c752, committed 2014-10-23
- Comitter:
- s1340735
- Date:
- Thu Oct 23 10:24:10 2014 +0000
- Parent:
- 9:a1890454e5a7
- Child:
- 11:5044290660b0
- Commit message:
- paar nieuwe comments
Changed in this revision
main.cpp | Show annotated file Show diff for this revision Revisions of this file |
--- a/main.cpp Thu Oct 23 07:40:07 2014 +0000 +++ b/main.cpp Thu Oct 23 10:24:10 2014 +0000 @@ -92,7 +92,8 @@ arm_biquad_cascade_df1_f32(&lowpassT, &filtered_emgT, &filtered_emgT, 1 ); filtered_emgT = fabs(filtered_emgT); - pc.printf("%u\n",filtered_emgT); + //sturen naar scherm (Realterm) + pc.printf("%f\r\n",filtered_emgT);//u=f filtered_emgT is een float //Triceps moving average T0=filtered_emgT; @@ -106,6 +107,8 @@ T3=T2; T2=T1; T1=T0; + + //sturen naar HID Scope scope.set(0,emg_valueT); //ruwe data scope.set(1,filtered_emgT); //filtered scope.send(); @@ -122,9 +125,9 @@ arm_biquad_cascade_df1_f32(&lowpassB, &filtered_emgB, &filtered_emgB, 1 ); filtered_emgB = fabs(filtered_emgB); + //sturen naar scherm pc.printf("%f\r\n",filtered_emgB); - //Biceps moving average B0=filtered_emgB; MOVAVG_B=B0*0.1+B1*0.1+B2*0.1+B3*0.1+B4*0.1+B5*0.1+B6*0.1+B7*0.1+B8*0.1+B9*0.1; @@ -138,7 +141,7 @@ B2=B1; B1=B0; - //naar scherm + //naar HID Scope scope.set(2,emg_valueB); //ruwe data scope.set(3,filtered_emgB); //filtered scope.send(); @@ -148,13 +151,14 @@ int main() { pc.baud(115200); + //bepaling van positie met triceps Ticker log_timerT; arm_biquad_cascade_df1_init_f32(&lowpassT,1,lowpass_const,lowpass_states); arm_biquad_cascade_df1_init_f32(&highpassT,1,highpass_const,highpass_states); log_timerT.attach(Triceps, 0.005); - wait(10); + wait(10); //log_timerT wordt 2000 keer uitgevoerd log_timerT.detach(); wait(5); @@ -162,15 +166,15 @@ Ticker log_timerB; arm_biquad_cascade_df1_init_f32(&lowpassB,1,lowpass_const,lowpass_states); arm_biquad_cascade_df1_init_f32(&highpassB,1,highpass_const,highpass_states); - + log_timerB.attach(Biceps,0.005); - wait(10); + wait(10);//log_timerB wordt 2000 keer uitgevoerd log_timerB.detach(); - -// positie van batje met behulp van Triceps + // positie van batje met behulp van Triceps drempelwaardeT1=4; drempelwaardeT2=7; + if (MOVAVG_T >= drempelwaardeT1) { yT1=1; if (MOVAVG_T >= drempelwaardeT1) { @@ -182,7 +186,8 @@ yT1=0; } - positie=yT1+yT2;//INPUT MOTOR 2 + //*** INPUT MOTOR 2 *** + positie=yT1+yT2; //controle positie op scherm if (positie==0) { @@ -196,13 +201,9 @@ } } } + //bepaling van snelheidsstand met biceps - arm_biquad_cascade_df1_init_f32(&lowpassB,1,lowpass_const,lowpass_states); - arm_biquad_cascade_df1_init_f32(&highpassB,1,highpass_const,highpass_states); - - - drempelwaardeB1=4; drempelwaardeB2=6; drempelwaardeB3=10; @@ -223,7 +224,8 @@ yB1=0; } - snelheidsstand=yB1+yB2+yB3;//INPUT MOTOR 1 + //*** INPUT MOTOR 1 *** + snelheidsstand=yB1+yB2+yB3; //controle snelheidsstand op scherm if (snelheidsstand==0) { @@ -242,4 +244,4 @@ } } -} +} \ No newline at end of file