Revision 14:bebdb2ac5ec6, committed 2014-10-24

Comitter:

s1340735

Date:

Fri Oct 24 07:44:01 2014 +0000

Parent:

13:9071a6b3c886

Child:

15:e779bfbeb8ea

Commit message:

void tricep2, drempelwaardes aangepast.

Changed in this revision

--- a/main.cpp	Fri Oct 24 07:24:19 2014 +0000
+++ b/main.cpp	Fri Oct 24 07:44:01 2014 +0000
@@ -23,9 +23,10 @@
 uint16_t emg_valueT;
 float emg_value_f32T;
 float filtered_emgT;
-float drempelwaardeT1, drempelwaardeT2;//T1=positie 1, T2=positie 2
+float drempelwaardeT;
 int yT1, yT2;
 float T0, T1, T2, T3, T4, T5, T6, T7, T8, T9, MOVAVG_T;//moving average objects
+float MOVAVG_Positie1, MOVAVG_Positie2;
 int positie;
 
 
@@ -56,7 +57,7 @@
     filtered_emgT = fabs(filtered_emgT);
 
     //sturen naar scherm (Realterm)
-    pc.printf("%f\r\n",filtered_emgT);//u=f filtered_emgT is een float
+    pc.printf("%f\r\n",filtered_emgT);
 
     //Triceps moving average
     T0=filtered_emgT;
@@ -115,22 +116,32 @@
 {
     pc.baud(115200);
 
-    //bepaling van positie met triceps
-    Ticker log_timerT;
+    //bepaling van positie met triceps 1
+    Ticker log_timerT1;
     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);
+    log_timerT1.attach(Triceps, 0.005);
     wait(60); //log_timerT wordt 2000 keer uitgevoerd
-    log_timerT.detach();
+    log_timerT1.detach();
+    
+    MOVAVG_T=MOVAVG_Positie1;
     
+    //bepaling van positie met tricep 2
+    Ticker log_timerT2;
+
+    log_timerT2.attach(Triceps, 0.005);
+    wait(60);
+    log_timerT2.detach();
+    
+    MOVAVG_T=MOVAVG_Positie2;
+
     // positie van batje met behulp van Triceps
-    drempelwaardeT1=4;
-    drempelwaardeT2=7;
+    drempelwaardeT=0.0001;
 
-    if (MOVAVG_T >= drempelwaardeT1) {
+    if (MOVAVG_Positie1 >= drempelwaardeT) {
         yT1=1;
-        if (MOVAVG_T >= drempelwaardeT1) {
+        if (MOVAVG_Positie2 >= drempelwaardeT) {
             yT2=1;
         } else {
             yT2=0;
@@ -138,6 +149,7 @@
     } else {
         yT1=0;
     }
+    
 
     //*** INPUT MOTOR 2 ***
     positie=yT1+yT2;
@@ -164,12 +176,12 @@
     log_timerB.attach(Biceps,0.005);
     wait(60);//log_timerB wordt 2000 keer uitgevoerd
     log_timerB.detach();
-    
+
     //bepaling van snelheidsstand met biceps
 
-    drempelwaardeB1=4;
-    drempelwaardeB2=6;
-    drempelwaardeB3=10;
+    drempelwaardeB1=0.0001;
+    drempelwaardeB2=0.001;
+    drempelwaardeB3=0.01;
 
     if (MOVAVG_B >= drempelwaardeB1) {
         yB1=1;