hello
Dependencies: AVEncoder QEI mbed-src-AV
Diff: main.cpp
- Revision:
- 0:fa523db3f4f5
- Child:
- 1:5b9fa1823663
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main.cpp Tue Oct 20 01:40:02 2015 +0000 @@ -0,0 +1,59 @@ +#include "mbed.h" + +PwmOut motor1_forward(PB_4); +PwmOut motor1_reverse(PB_10); +PwmOut motor2_forward(PA_7); +PwmOut motor2_reverse(PB_6); + +DigitalOut myled(LED1); + +void rightForward(float speed); +void leftForward(float speed); + +int main() { + rightForward(0.5); + leftForward(-0.5); + // mypwm.period_ms(10); + //mypwm.pulsewidth_ms(1); + + //printf("pwm set to %.2f %%\n", mypwm.read() * 100); + + while(1) { + myled = !myled; + wait(1); + } +} + +void rightForward(float speed) { + if (speed == 0) { + motor1_forward = 1.0; + motor1_reverse = 1.0; + } + + if (speed > 0) { + motor1_forward = speed; + motor1_reverse = 0; + } + + else { + motor1_forward = 0; + motor1_reverse = -speed; + } +} + +void leftForward(float speed) { + if (speed == 0) { + motor2_forward = 1.0; + motor2_reverse = 1.0; + } + + if (speed > 0) { + motor2_forward = speed; + motor2_reverse = 0; + } + + else { + motor2_forward = 0; + motor2_reverse = -speed; + } +} \ No newline at end of file