Richard Ames
/
rover_on_freedom
Rover for Freedom board
Fork of mbed_blinky by
main.cpp@8:ed9204f71104, 2018-03-12 (annotated)
- Committer:
- RichardAmes
- Date:
- Mon Mar 12 23:01:33 2018 +0000
- Revision:
- 8:ed9204f71104
- Parent:
- 4:81cea7a352b0
Rover code for Freedom board
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
dan | 0:7dec7e9ac085 | 1 | #include "mbed.h" |
RichardAmes | 8:ed9204f71104 | 2 | #include "Servo.h" |
RichardAmes | 8:ed9204f71104 | 3 | |
RichardAmes | 8:ed9204f71104 | 4 | Servo myservo(PTB0); |
dan | 0:7dec7e9ac085 | 5 | |
RichardAmes | 8:ed9204f71104 | 6 | DigitalOut myled(LED3); |
RichardAmes | 8:ed9204f71104 | 7 | PwmOut motorA(PTD0); |
RichardAmes | 8:ed9204f71104 | 8 | PwmOut motorB(PTD5); |
RichardAmes | 8:ed9204f71104 | 9 | DigitalOut dirB1(PTA13); |
RichardAmes | 8:ed9204f71104 | 10 | DigitalOut dirB2(PTC9); |
RichardAmes | 8:ed9204f71104 | 11 | DigitalOut dirA2(PTC8); |
RichardAmes | 8:ed9204f71104 | 12 | DigitalOut dirA1(PTA5); |
RichardAmes | 8:ed9204f71104 | 13 | |
RichardAmes | 8:ed9204f71104 | 14 | float p = 0; |
dan | 0:7dec7e9ac085 | 15 | |
dan | 0:7dec7e9ac085 | 16 | int main() { |
RichardAmes | 8:ed9204f71104 | 17 | |
dan | 0:7dec7e9ac085 | 18 | while(1) { |
RichardAmes | 8:ed9204f71104 | 19 | myservo = p; |
RichardAmes | 8:ed9204f71104 | 20 | p += 0.05; |
RichardAmes | 8:ed9204f71104 | 21 | if (p > 1) |
RichardAmes | 8:ed9204f71104 | 22 | p = 0; |
dan | 0:7dec7e9ac085 | 23 | myled = 1; |
RichardAmes | 8:ed9204f71104 | 24 | dirB1 = 1; |
RichardAmes | 8:ed9204f71104 | 25 | dirB2 = 0; |
RichardAmes | 8:ed9204f71104 | 26 | dirA1 = 0; |
RichardAmes | 8:ed9204f71104 | 27 | dirA2 = 1; |
RichardAmes | 8:ed9204f71104 | 28 | motorA.period(0.01f); |
RichardAmes | 8:ed9204f71104 | 29 | motorA.write(0.0f); |
RichardAmes | 8:ed9204f71104 | 30 | motorB.period(0.01f); |
RichardAmes | 8:ed9204f71104 | 31 | motorB.write(0.0f); |
RichardAmes | 8:ed9204f71104 | 32 | wait(1); |
dan | 0:7dec7e9ac085 | 33 | myled = 0; |
RichardAmes | 8:ed9204f71104 | 34 | motorA.write(0.5f); |
RichardAmes | 8:ed9204f71104 | 35 | motorB.write(0.5f); |
RichardAmes | 8:ed9204f71104 | 36 | wait(1); |
RichardAmes | 8:ed9204f71104 | 37 | |
RichardAmes | 8:ed9204f71104 | 38 | myled = 1; |
RichardAmes | 8:ed9204f71104 | 39 | dirB1 = 0; |
RichardAmes | 8:ed9204f71104 | 40 | dirB2 = 1; |
RichardAmes | 8:ed9204f71104 | 41 | dirA1 = 1; |
RichardAmes | 8:ed9204f71104 | 42 | dirA2 = 0; |
RichardAmes | 8:ed9204f71104 | 43 | motorA.period(0.01f); |
RichardAmes | 8:ed9204f71104 | 44 | motorA.write(0.0f); |
RichardAmes | 8:ed9204f71104 | 45 | motorB.period(0.01f); |
RichardAmes | 8:ed9204f71104 | 46 | motorB.write(0.0f); |
RichardAmes | 8:ed9204f71104 | 47 | wait(1); |
RichardAmes | 8:ed9204f71104 | 48 | myled = 0; |
RichardAmes | 8:ed9204f71104 | 49 | motorA.write(0.5f); |
RichardAmes | 8:ed9204f71104 | 50 | motorB.write(0.5f); |
RichardAmes | 8:ed9204f71104 | 51 | wait(1); |
RichardAmes | 8:ed9204f71104 | 52 | |
stevep | 4:81cea7a352b0 | 53 | } |
dan | 0:7dec7e9ac085 | 54 | } |