Diff: main.cpp

Revision:

11:73817c9df1e5

Parent:

10:2f76fa4cd2a7

Child:

12:0a079e86348e

--- a/main.cpp	Thu Oct 01 13:25:04 2015 +0000
+++ b/main.cpp	Thu Oct 01 13:58:16 2015 +0000
@@ -5,18 +5,23 @@
 //Motor 2
 DigitalOut motor2direction(D4); //D4 en D5 zijn motor 2 (op het motorshield)
 PwmOut motor2speed(D5);
-//DigitalIn buttonL1(PTC6);
-//DigitalIn buttonL2(PTA4);
-//DigitalIn buttonH1(D2);
-//DigitalIn buttonH2(D6);
-//AnalogIn potmeter(A1);
 
+Encoder encoder(D13,D12); // kanalen waar de encoder op zit
+MODSERIAL pc(USBTX,USBRX); //zorgt er voor dat putty kan schrijven
+
+//4200 counts per rev. counts/4200 = rev
 
 int main()
 {
-    for(float p = 0.0f; p < 1.0f; p += 0.01f) {
-        motor2speed = p;
-        wait(1);
-        break;
+    pc.baud(9600);
+    
+    while(1) {
+
+        for (double n=0.0f; n<1.0f; n+=0.1f) {
+            encoder.setPosition(0);
+            motor2speed = n;
+            pc.printf("position: %d\r\n", encoder.getPosition());
+            wait(5);
+        }
     }
 }
\ No newline at end of file