Diff: main.cpp

Revision:

4:a92d354265b2

Parent:

3:61c024f896ad

Child:

5:14f6189d86a2

--- a/main.cpp	Mon Sep 21 10:43:37 2015 +0000
+++ b/main.cpp	Mon Sep 21 11:14:11 2015 +0000
@@ -7,21 +7,23 @@
 DigitalOut motor2direction(D4); //D4 en D5 zijn motor 2 (op het motorshield)
 PwmOut motor2speed(D5);
 DigitalIn button(PTA4);
+Encoder motor2(D13,D12,true);
+MODSERIAL pc(USBTX,USBRX);
+
 
 int main()
 {
+    pc.baud(9600);
     while(true) {
-        if (button.read() == 0) {   //if button pressed
+        if (button.read() < 0.5) {   //if button pressed
             motor2direction = 1;
             motor2speed = 0.3f;
+            //pc.printf("positie = %d \n", motor2.getPosition());
         } else {                    // If button is not pressed
             motor2direction = 0;
-            motor2speed = 0.3f;
+            motor2speed = 0;
+            //pc.printf("positie = %d \n", motor2.getPosition());
         }
-        double position = getPosition();
-        printf("positie = %d", position);
+        //pc.printf("positie = %d \n", motor2.getPosition());
     }
 }
-
-// Geen functie hieronder nog
-// Encoder encoder1(D13,D12);
\ No newline at end of file