Rover for Freedom board

Dependencies:   mbed

Fork of mbed_blinky by Mbed

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?

UserRevisionLine numberNew 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 }