Fernon Eijkhoudt
/
ROBOBIRDS_FINAL
EMG driven robot which shoots elastic bands
Fork of RoboBirdV1 by
Diff: main.cpp
- Revision:
- 1:bb11e38dda43
- Parent:
- 0:5a5f417fa1b2
- Child:
- 2:f0e9ffc5df09
diff -r 5a5f417fa1b2 -r bb11e38dda43 main.cpp --- 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);