Fernon Eijkhoudt
/
ROBOBIRDS_FINAL
EMG driven robot which shoots elastic bands
Fork of RoboBirdV1 by
Diff: main.cpp
- Revision:
- 0:5a5f417fa1b2
- Child:
- 1:bb11e38dda43
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main.cpp Wed Sep 23 09:07:24 2015 +0000 @@ -0,0 +1,25 @@ +#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); +// hier nog signaal encoder + +int main() +{ + while (true) { + for (int n = 0; n < 2; n++) { + Direction.write(0); + PowerMotor.write(0.5); + wait (1); + Direction.write(1); + wait (1); + } + PowerMotor.write(0); + return (0); + } +} \ No newline at end of file