emg_mk

Dependencies:   HIDScope MODSERIAL mbed-dsp mbed

Files at this revision

API Documentation at this revision

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