sibren vuurberg / Mbed 2 deprecated Project_code_groep12

EMG check. met knopjes en toetsenboard emg signalen simuleren om de code te testen. groepje 12

Dependencies:   MODSERIAL QEI mbed

Fork of EMG_check by sibren vuurberg

Diff: main.cpp

Revision:
18:cd292bac4524
Parent:
17:f44f41cab151
--- a/main.cpp	Wed Oct 19 15:31:31 2016 +0000
+++ b/main.cpp	Wed Oct 19 15:33:19 2016 +0000
@@ -102,6 +102,22 @@
         snelheid_motor2 = ((current_position_motor2 - previous_position_motor2)*6.28318530718) / ticker_TS;
         pc.printf("snelheid motor 2 is: %f \r\n", snelheid_motor2);
         
+    if (snelheid_motor1 > 4.9) && (snelheid_motor1 != 0){  // dit moet ook in minder if loops kunnen moet nog ff uitvogelen hoe
+     a=a-0.02;
+    }
+   else if (snelheid_motor1 < 4.9) && (snelheid_motor1 != 0){
+     a=a+0.02;
+    }
+     if (snelheid_motor2 > 4.9) && (snelheid_motor2 != 0){
+     b=b-0.02;
+    }
+   else if (snelheid_motor2 < 4.9) && (snelheid_motor2 != 0){
+     b=b+0.02;
+    }
+     else {
+        a=a;
+        b=b;
+        }
         
         tickerflag = 0;
         }
@@ -144,6 +160,23 @@
         snelheid_motor2 = ((current_position_motor2 - previous_position_motor2)*6.28318530718) / ticker_TS;
         pc.printf("snelheid motor 2 is: %f \r\n", snelheid_motor2);
         
+        if (snelheid_motor1 > 4.9) && (snelheid_motor1 != 0){  // dit moet ook in minder if loops kunnen moet nog ff uitvogelen hoe
+     a=a-0.02;
+    }
+   else if (snelheid_motor1 < 4.9) && (snelheid_motor1 != 0){
+     a=a+0.02;
+    }
+     if (snelheid_motor2 > 4.9) && (snelheid_motor2 != 0){
+     b=b-0.02;
+    }
+   else if (snelheid_motor2 < 4.9) && (snelheid_motor2 != 0){
+     b=b+0.02;
+    }
+     else {
+        a=a;
+        b=b;
+        }
+        
         tickerflag = 0;
         }
     }