Diff: main.cpp

Revision:

4:2b3fbd7ef1cf

Parent:

3:34f7c16a6a7f

Child:

5:6777d59c5351

--- a/main.cpp	Sun Sep 25 12:13:20 2016 +0000
+++ b/main.cpp	Fri Sep 30 09:16:26 2016 +0000
@@ -5,6 +5,10 @@
 DigitalOut led2(LED_BLUE);
 InterruptIn sw3(SW3);
 Serial pc(USBTX, USBRX);
+DigitalOut motor1(D4);
+PwmOut pwm_motor1(D5);
+DigitalOut motor2(D7);
+PwmOut pwm_motor2(D6);
 int n = 0;
  
 void SwitchN() {                        // maakt simpele functie die 1 bij n optelt
@@ -26,13 +30,21 @@
          if (n%2==0)                     // als s ingedrukt wordt en het getal is even gebeurd het onderstaande
          {
            pc.printf("n is even \n\r"); // print lijn "n is even"
-           pc.printf("up \n\r");        // print lijn "up"         
+           pc.printf("up \n\r");        // print lijn "up"   
+           motor1 = 1;
+           pwm_motor1 = 1;     
+           wait (0.05);
          } 
+         pwm_motor1 = 0;
          else                           // als s is ingedrukt maar het getal is niet even (dus oneven) gebeurdt het onderstaande
          {
            pc.printf("n is odd \n\r");  // print lijn "n is odd"
            pc.printf("left \n\r");      // print lijn "left"
-         }            
+           motor2 = 1;
+           pwm_motor2 = 1;
+          wait (0.05);
+         }      
+          pwm_motor2 = 0;      
     }
     else if (c=='d')                     // als d ingedrukt wordt gebeurd het volgende
     {
@@ -40,12 +52,21 @@
          {
            pc.printf("n is even \n\r"); // print lijn "n is even"
            pc.printf("down \n\r");      // print lijn "down"   
+           motor1 = 0;
+           pwm_motor1 = 1;
+           wait (0.05);
+           
          } 
+         pwm_motor1 = 0;
          else                           // als d is ingedrukt maar het getal is niet even (dus oneven) gebeurdt het onderstaande
          {
            pc.printf("n is odd \n\r"); // print lijn "n is odd"
            pc.printf("right \n\r");    // print lijn "right"
-         }                 
+           motor2 = 0;
+           pwm_motor2 = 1;
+           wait (0.05); 
+         }     
+         pwm_motor2=0;            
     }    
            
 }