Diff: main.cpp

Revision:

5:4010889f1c85

Parent:

3:66b76df8eaef

--- a/main.cpp	Mon Oct 15 10:11:07 2018 +0000
+++ b/main.cpp	Mon Oct 15 13:06:14 2018 +0000
@@ -12,8 +12,8 @@
 DigitalOut directionpin2(D7); // SPECIFIC PIN (hoeft niet aangesloten te worden) Direction value (0-1) that the mbed will give the motor: in which direction the motor must rotate
 AnalogIn potmeter1(A4); // Analoge input van potmeter 1 -> Motor 1
 AnalogIn potmeter2(A1); // Analoge input van potmeter 2 -> Motor 2
-QEI encoder1(D13, D12, NC, 1, QEI::X4_ENCODING); // Reads encoder, connect pins of encoder 1 to D12 and D13; NC: not connected pin (for X4); 6533 prm (counts per rotation)
-QEI encoder2(D11, D10, NC, 1, QEI::X4_ENCODING); // Reads encoder, connect pins of encoder 1 to D12 and D13; NC: not connected pin (for X4); 6533 prm (counts per rotation)
+QEI encoder1(D13, D12, NC, 6533, QEI::X4_ENCODING); // Reads encoder, connect pins of encoder 1 to D12 and D13; NC: not connected pin (for X4); 6533 prm (counts per rotation)
+QEI encoder2(D11, D10, NC, 6533, QEI::X4_ENCODING); // Reads encoder, connect pins of encoder 2 to D12 and D13; NC: not connected pin (for X4); 6533 prm (counts per rotation)
 Serial pc(USBTX, USBRX);        // Sends encoder counts to PC
 
 volatile float counts_motor1;
@@ -56,7 +56,7 @@
     enc.attach(encoder_counter,0.5);
     while(1)
     {
-    pc.printf("Pulses encoder1 is: %i \n\r Pulses encoder2 is: %i \n\r angle1 %.2f \n\r angle2 %.2f \n\r", encoder1.getPulses(), encoder2.getPulses(), angle_motor1, angle_motor2);
-    wait(0.1);
+    pc.printf("Pulses encoder1 is: %f or %i\n\r angle1 %.2f \n\r Pulses encoder2 is: %f \n\r angle2 %.2f \n\r", counts_motor1, encoder1.getPulses(),angle_motor1, counts_motor2, angle_motor2);
+    wait(0.5);
     }
 }
\ No newline at end of file