Ping Pong robot

Dependencies:   mbed

Files at this revision

API Documentation at this revision

Comitter:
JKleinRot
Date:
Mon Oct 13 07:10:34 2014 +0000
Parent:
0:c37e4d7f1f56
Child:
2:fbda25b453b3
Commit message:
eerste opzet met comments

Changed in this revision

main.cpp Show annotated file Show diff for this revision Revisions of this file
--- a/main.cpp	Fri Oct 10 13:20:35 2014 +0000
+++ b/main.cpp	Mon Oct 13 07:10:34 2014 +0000
@@ -4,7 +4,7 @@
 
 #define BLABLA      waarde      //Constanten definiëren en een waarde toekennen
 
-//Pinverdeling
+//Pinverdeling en naamgeving variabelen
 Encoder motor_arm1(
 Encoder motor_arm2(             //
 
@@ -35,27 +35,27 @@
    //ticker maken die iedere zoveel seconden de EMG data inlaadt
    sample_EMG.attach(setsample_EMGflag,0.005);
    
-   while (1){
+   while (1){                   //Oneindige while loop
        if (rust = false && kalibratie_positie = false && kalibratie_EMG = false){
-            lcd_r1 = " BMT M9   GR. 4 ";
-            lcd_r2 = "Hoi! Ik ben PIPO";
-            wait(2);
+            lcd_r1 = " BMT M9   GR. 4 ";    //Tekst in LCD scherm
+            lcd_r2 = "Hoi! Ik ben PIPO";    //Tekst in LCD scherm  
+            wait(2);                        //2 seconden wachten
             rust = true
        }
          
     
        if (rust = true && kalibratie_positie = false && kalibratie_EMG = false){
-            wait(1);
+            wait(1);                        //1 seconde wachten
         
-            pwm_motor_arm1 = 0.02036
-            dir_motor_arm1 = // 1 of 0
+            pwm_motor_arm1 = 0.02036        //Dutycycle/100
+            dir_motor_arm1 = // 1 of 0      //Richting motor
         
-            while(motor_arm1 < 363){
+            while(motor_arm1 < 363){        //Zolang aantal encoderpulsen < 363 --> PWM motor1 blijft gelijk
                 pwm_motor_arm1 = 0.02036
             }
         
-            pwm_motor_arm1 = 0
-            motor_arm1 = 0
+            pwm_motor_arm1 = 0              //Na while loop PWM motor1 op nul
+            motor_arm1 = 0                  //Encoderpulsen op nul zetten
         
             pwm_motor_arm2 = 0.02398
             dir_motor_arm2 = // 1 of 0
@@ -67,16 +67,16 @@
             pwm_motor_arm2 = 0
             motor_arm2 = 0
         
-            lcd_r1 = "  Beginpositie  "
-            lcd_r2 = "    ingesteld   "
-            wait(2);
+            lcd_r1 = "  Beginpositie  "     //Tekst in LCD scherm
+            lcd_r2 = "    ingesteld   "     //Tekst in LCD scherm   
+            wait(2);                        //2 seconden wachten
             kalibratie_positie = true
        }
     
        if (rust = true && kalibratie_positie = true && kalibratie_EMG = false){
-            wait(1);
+            wait(1);                        //1 seconde wachten
         
-            ybk = emg_bi.read();
+            ybk = emg_bi.read();            
             ytk = emg_tri.read();
         
             //detrend