![](/media/cache/group/default_image.jpg.50x50_q85.jpg)
emg
Dependencies: HIDScope MODSERIAL mbed-dsp mbed TouchButton
Fork of test by
Diff: main.cpp
- Revision:
- 36:ccc901c169b7
- Parent:
- 35:e60f09b575d7
- Child:
- 37:8b15c29445d3
--- a/main.cpp Tue Oct 28 11:11:56 2014 +0000 +++ b/main.cpp Tue Oct 28 12:47:57 2014 +0000 @@ -17,15 +17,14 @@ DigitalOut myled3(LED3);//blue /* FRDM-KL25Z built-in touch slider -************************* -* * * * * -* 1 * 2 * 3 * 4 * -* * * * * -************************* +******************* +* * * * +* 1 * 2 * 3 * +* * * * +******************* * key 1 will light Red LED -> CALIBRATIE TRICEPS * key 2 will light Green LED -> CALIBRATIE BICEPS * key 3 will light Blue LED -> START -* key 4 will light White LED (R+G+B) -> ?ONBEKEND */ //*** OBJECTS *** @@ -167,23 +166,26 @@ { pc.baud(115200); - TouchButton TButton; - - int key; - drempelwaardeT=0; drempelwaardeB1=0; drempelwaardeB2=0; drempelwaardeB3=0; - key = TButton.PresedButton(); + TouchButton TButton; + + int key=0; + key = TButton.PressedButton(); pc.printf("key 1 calibratie triceps/n"); pc.printf("key 2 caliratie biceps/n"); pc.printf("key 3 START/n"); + wait(3); + if (key==0) { - myled1 = 1; + + //rood + myled1 = 0; myled2 = 1; myled3 = 1; @@ -191,173 +193,186 @@ Calibratie_Triceps(); drempelwaardeT=MOVAVG_T-1; pc.printf("drempelwaarde triceps is %f\r\n", drempelwaardeT); - pc.printf("calibratie tricep klaar\n"); - wait(5); - } - - if (key==1) { - myled1 = 1; - myled2 = 1; - myled3 = 0; - wait(0.1); - - pc.printf("calibratie bicep snelheid 1 aan\n"); - Calibratie_Biceps(); - drempelwaardeB1=MOVAVG_B-1; - pc.printf("drempelwaarde snelheid 1 is %f\r\n", drempelwaardeB1); - wait(5); - - pc.printf("calibratie bicep snelheid 2 aan\n"); - Calibratie_Biceps(); - drempelwaardeB2=MOVAVG_B-1; - pc.printf("drempelwaarde snelheid 2 is %f\r\n", drempelwaardeB2); + pc.printf("calibratie tricep klaar, accord? -> key 4 \n"); wait(5); - pc.printf("calibratie bicep snelheid 2 aan\n"); - Calibratie_Biceps(); - drempelwaardeB2=MOVAVG_B-1; - pc.printf("drempelwaarde snelheid 3 is %f\r\n", drempelwaardeB3); + if (key==3) { + + pc.printf("key 2 caliratie biceps/n"); + pc.printf("key 3 START/n"); + wait(3); + + if (key==1) { - pc.printf("caliratie biceps is klaar/n"); + //green + myled1 = 1; + myled2 = 0; + myled3 = 1; + wait(0.1); - wait(5); - } + pc.printf("calibratie bicep snelheid 1 aan\n"); + Calibratie_Biceps(); + drempelwaardeB1=MOVAVG_B-1; + pc.printf("drempelwaarde snelheid 1 is %f\r\n", drempelwaardeB1); + wait(5); - if (key==2) { - if (drempelwaardeT==0) { - pc.printf("voer calibratie triceps uit"); - } else if (drempelwaardeB1==0) { - pc.printf("voer calibratie biceps uit"); - } else if (drempelwaardeB2==0) { - pc.printf("voer calibratie biceps uit"); - } else if (drempelwaardeB3==0) { - pc.printf("voer calibratie biceps uit"); - } else { - myled1 = 1; - myled2 = 0; - myled3 = 1; - wait(0.1); + pc.printf("calibratie bicep snelheid 2 aan\n"); + Calibratie_Biceps(); + drempelwaardeB2=MOVAVG_B-1; + pc.printf("drempelwaarde snelheid 2 is %f\r\n", drempelwaardeB2); + wait(5); - pc.printf("eerst positie dan snelheid aangeven/n"); + pc.printf("calibratie bicep snelheid 2 aan\n"); + Calibratie_Biceps(); + drempelwaardeB2=MOVAVG_B-1; + pc.printf("drempelwaarde snelheid 3 is %f\r\n", drempelwaardeB3); + + pc.printf("caliratie biceps is klaar, accord? -> key 4/n"); - //bepaling van positie met triceps 1 - Ticker log_timerT1; + wait(5); + + if (key==3) { + + pc.printf("key 2 caliratie biceps/n"); + pc.printf("key 3 START/n"); + wait(3); - arm_biquad_cascade_df1_init_f32(¬chT,1,notch_const,notch_states); - arm_biquad_cascade_df1_init_f32(&lowpassT,1,lowpass_const,lowpass_states); - arm_biquad_cascade_df1_init_f32(&highpassT,1,highpass_const,highpass_states); + if (key==2) { + if (drempelwaardeT==0) { + pc.printf("voer calibratie triceps uit"); + } else if (drempelwaardeB1==0) { + pc.printf("voer calibratie biceps uit"); + } else if (drempelwaardeB2==0) { + pc.printf("voer calibratie biceps uit"); + } else if (drempelwaardeB3==0) { + pc.printf("voer calibratie biceps uit"); + } else { - log_timerT1.attach(Triceps, 0.005); - wait(10); - log_timerT1.detach(); + //blue + myled1 = 1; + myled2 = 1; + myled3 = 0; + wait(0.1); - MOVAVG_T=MOVAVG_Positie1; - - // positie van batje met behulp van Triceps + pc.printf("eerst positie dan snelheid aangeven/n"); - if (MOVAVG_Positie1>= drempelwaardeT) { - yT1=1; - } else { - yT1=0; - } + //bepaling van positie met triceps 1 + Ticker log_timerT1; - pc.printf("Triceps eerste meting is klaar.\n"); - wait(5); + arm_biquad_cascade_df1_init_f32(¬chT,1,notch_const,notch_states); + 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_timerT1.attach(Triceps, 0.005); + wait(10); + log_timerT1.detach(); - //bepaling van positie met tricep 2 - Ticker log_timerT2; + MOVAVG_T=MOVAVG_Positie1; + + // positie van batje met behulp van Triceps - arm_biquad_cascade_df1_init_f32(¬chT,1,notch_const,notch_states); - arm_biquad_cascade_df1_init_f32(&lowpassT,1,lowpass_const,lowpass_states); - arm_biquad_cascade_df1_init_f32(&highpassT,1,highpass_const,highpass_states); + if (MOVAVG_Positie1>= drempelwaardeT) { + yT1=1; + } else { + yT1=0; + } - log_timerT2.attach(Triceps, 0.005); - wait(5); - log_timerT2.detach(); - - MOVAVG_T=MOVAVG_Positie2; + pc.printf("Triceps eerste meting is klaar.\n"); + wait(5); - if (MOVAVG_Positie2 >= drempelwaardeT) { - yT2=1; - } else { - yT2=0; - } + //bepaling van positie met tricep 2 + Ticker log_timerT2; + + arm_biquad_cascade_df1_init_f32(¬chT,1,notch_const,notch_states); + arm_biquad_cascade_df1_init_f32(&lowpassT,1,lowpass_const,lowpass_states); + arm_biquad_cascade_df1_init_f32(&highpassT,1,highpass_const,highpass_states); - pc.printf("Triceps tweede meting is klaar.\n"); + log_timerT2.attach(Triceps, 0.005); + wait(5); + log_timerT2.detach(); + + MOVAVG_T=MOVAVG_Positie2; - //*** INPUT MOTOR 2 *** - positie=yT1+yT2; + if (MOVAVG_Positie2 >= drempelwaardeT) { + yT2=1; + } else { + yT2=0; + } - //controle positie op scherm - if (positie==0) { - pc.printf("Motor 2 blijft op stand 1\n"); - } else { - if (positie==1) { - pc.printf("Motor 2 gaat naar stand 2\n"); - } else { - if (positie==2) { - pc.printf("Motor 2 gaat naar stand 3\n"); - } - } - } + pc.printf("Triceps tweede meting is klaar.\n"); + + //*** INPUT MOTOR 2 *** + positie=yT1+yT2; - wait(5); - - Ticker log_timerB; + //controle positie op scherm + if (positie==0) { + pc.printf("Motor 2 blijft op stand 1\n"); + } else { + if (positie==1) { + pc.printf("Motor 2 gaat naar stand 2\n"); + } else { + if (positie==2) { + pc.printf("Motor 2 gaat naar stand 3\n"); + } + } + } - arm_biquad_cascade_df1_init_f32(¬chB,1,notch_const,notch_states); - arm_biquad_cascade_df1_init_f32(&lowpassB,1,lowpass_const,lowpass_states); - arm_biquad_cascade_df1_init_f32(&highpassB,1,highpass_const,highpass_states); + wait(5); + + Ticker log_timerB; - log_timerB.attach(Biceps,0.005); - wait(5); - log_timerB.detach(); + arm_biquad_cascade_df1_init_f32(¬chB,1,notch_const,notch_states); + arm_biquad_cascade_df1_init_f32(&lowpassB,1,lowpass_const,lowpass_states); + arm_biquad_cascade_df1_init_f32(&highpassB,1,highpass_const,highpass_states); - //bepaling van snelheidsstand met biceps + log_timerB.attach(Biceps,0.005); + wait(5); + log_timerB.detach(); + + //bepaling van snelheidsstand met biceps - if (MOVAVG_B >= drempelwaardeB1) { - yB1=1; - if (MOVAVG_B >= drempelwaardeB2) { - yB2=1; - if (MOVAVG_B >= drempelwaardeB3) { - yB3=1; - } else { - yB3=0; - } - } else { - yB2=0; - } - } else { - yB1=0; - } + if (MOVAVG_B >= drempelwaardeB1) { + yB1=1; + if (MOVAVG_B >= drempelwaardeB2) { + yB2=1; + if (MOVAVG_B >= drempelwaardeB3) { + yB3=1; + } else { + yB3=0; + } + } else { + yB2=0; + } + } else { + yB1=0; + } - //*** INPUT MOTOR 1 *** - snelheidsstand=yB1+yB2+yB3; + //*** INPUT MOTOR 1 *** + snelheidsstand=yB1+yB2+yB3; - //controle snelheidsstand op scherm - if (snelheidsstand==0) { - pc.printf("Motor 1 beweegt niet\n"); - } else { - if (snelheidsstand==1) { - pc.printf("Motor 1 beweegt met snelheid 1\n"); - } else { - if (snelheidsstand==2) { - pc.printf("Motor 1 beweegt met snelheid 2\n"); - } else { - if (snelheidsstand==3) { - pc.printf("Motor 1 beweegt met snelheid 3\n"); + //controle snelheidsstand op scherm + if (snelheidsstand==0) { + pc.printf("Motor 1 beweegt niet\n"); + } else { + if (snelheidsstand==1) { + pc.printf("Motor 1 beweegt met snelheid 1\n"); + } else { + if (snelheidsstand==2) { + pc.printf("Motor 1 beweegt met snelheid 2\n"); + } else { + if (snelheidsstand==3) { + pc.printf("Motor 1 beweegt met snelheid 3\n"); + } + } + } + } } } } } } - if(key==3) { - myled1 = 0; - myled2 = 1; - myled3 = 1; - wait(0.1); + } +} - pc.printf("onbekend\n"); - } - } -} \ No newline at end of file + +