EMG driven robot which shoots elastic bands

Dependencies:   QEI mbed

Fork of ROBOBIRDS_FINAL by Fernon Eijkhoudt

Revision:
1:bb11e38dda43
Parent:
0:5a5f417fa1b2
Child:
2:f0e9ffc5df09
--- a/main.cpp	Wed Sep 23 09:07:24 2015 +0000
+++ b/main.cpp	Wed Sep 23 12:19:33 2015 +0000
@@ -1,18 +1,26 @@
 #include "mbed.h"
 #include "QEI.h"
 
-//Motor 2 D4 en D5
-//D4 direction
-//D5 PWM
+DigitalOut Direction(D4); //1 = CCW - 0 = CW
+PwmOut PowerMotor(D5); //van 0 tot 1
+AnalogIn PotMeter(A1);
+QEI Encoder(D13,D12,NC,32,QEI::X2_ENCODING); //Encoder
+Serial pc(USBTX, USBRX);
 
-DigitalOut Direction(D4); //1 = CCW - 0 = CW
-PwmOut PowerMotor(D5);
-// hier nog signaal encoder
+double P;
+const double pi = 3.14159265359;
+int Pulses; 
 
 int main()
 {
     while (true) {
+        pc.baud(115200);
         for (int n = 0; n < 2; n++) {
+            //P = PotMeter.read();
+            //pc.printf('P = %f/n', P);
+            Pulses = Encoder.getPulses();
+            pc.printf ("Pulses = %i", Pulses);
+            //  pc.printf ("K = %i \n", K);
             Direction.write(0);
             PowerMotor.write(0.5);
             wait (1);