Diff: main.cpp

Revision:

10:ac36f9a204dd

Parent:

9:65c52c1f4a57

Child:

11:3efd6a324f16

diff -r 65c52c1f4a57 -r ac36f9a204dd main.cpp
--- a/main.cpp	Mon Oct 08 10:30:19 2018 +0000
+++ b/main.cpp	Mon Oct 08 13:28:40 2018 +0000
@@ -1,31 +1,39 @@
 #include "mbed.h"
 #include "FastPWM.h"
 
-
 Ticker motor;
 
-
 AnalogIn pot1(A1);
 AnalogIn pot2(A2);
 InterruptIn button2(SW2);
 InterruptIn button3(SW3);
 
+DigitalOut pin2(D2);    // Motor 3 direction
 FastPWM pin3(D3);       // Motor 3 pwm
-DigitalOut pin2(D2);    // Motor 3 direction
+DigitalOut pin4(D4);    // Motor 2 direction
 FastPWM pin5(D5);       // Motor 2 pwm
-DigitalOut pin4(D4);    // Motor 2 direction
 FastPWM pin6(D6);       // Motor 1 pwm
 DigitalOut pin7(D7);    // Motor 1 direction
 //float u1  = pot1;
 
+DigitalIn pin8(D8);     // Encoder 1 B
+DigitalIn pin9(D9);     // Encoder 1 A
+DigitalIn pin10(D10);   // Encoder 2 B
+DigitalIn pin11(D11);   // Encoder 2 A
+DigitalIn pin12(D12);   // Encoder 3 B
+DigitalIn pin13(D13);   // Encoder 3 A
+
 float b;
 
 void draaisnel()
     {   if(button2 == 1)
-        { //Hier maak ik een interrupt voor meer snelheid
+        {   //Interrupt voor rotatierichting clockwise
             b = 0.4;  //In stapjes van 0.1
             pin3 = fabs(b);
         }
+        else if (button2 == 0)
+        {   //Interrupt voor rotatierichting 
+        }
     }
 void draailangzaam()
     {   if(button3 == 1)
@@ -68,7 +76,7 @@
     pin6 = fabs(u2);     
 }
 int main(){
-    
+    pin3 = 0.0;
     pin5.period(1.0/10000);
     button2.rise(&draaisnel);       // interrupt koppelen
     button3.rise(&draailangzaam);