bbb

Dependencies:   m3pi mbed

Fork of Serial by Ling Ye

Committer:
lingye96
Date:
Wed Nov 02 19:44:07 2016 +0000
Revision:
1:a95f56d5e053
Parent:
0:48d48099e20c
asdf

Who changed what in which revision?

UserRevisionLine numberNew contents of line
lingye96 0:48d48099e20c 1 #include "mbed.h"
lingye96 0:48d48099e20c 2 #include "m3pi.h"
lingye96 0:48d48099e20c 3
lingye96 0:48d48099e20c 4 m3pi m3pi;
lingye96 1:a95f56d5e053 5 Serial pc(USBTX, USBRX);
lingye96 0:48d48099e20c 6
lingye96 0:48d48099e20c 7 int main() {
lingye96 0:48d48099e20c 8
lingye96 0:48d48099e20c 9 m3pi.locate(0,1);
lingye96 1:a95f56d5e053 10 pc.printf("Press and control the m3pi\n");
lingye96 1:a95f56d5e053 11 while(1)
lingye96 0:48d48099e20c 12 {
lingye96 1:a95f56d5e053 13 char c = pc.getc();
lingye96 1:a95f56d5e053 14 if(c =='w')
lingye96 0:48d48099e20c 15 {
lingye96 0:48d48099e20c 16 m3pi.forward(0.5); // Forward half speed
lingye96 1:a95f56d5e053 17 wait (0.25); // wait half a second
lingye96 1:a95f56d5e053 18 m3pi.stop();
lingye96 1:a95f56d5e053 19 }
lingye96 1:a95f56d5e053 20 if (c =='a')
lingye96 0:48d48099e20c 21 {
lingye96 0:48d48099e20c 22 m3pi.left(0.5); // Turn left at half speed
lingye96 1:a95f56d5e053 23 wait (0.25); // wait half a second
lingye96 1:a95f56d5e053 24 m3pi.stop();
lingye96 1:a95f56d5e053 25 }
lingye96 1:a95f56d5e053 26 if (c =='s')
lingye96 0:48d48099e20c 27 {
lingye96 1:a95f56d5e053 28 m3pi.backward(0.5); // Turn left at half speed
lingye96 1:a95f56d5e053 29 wait (0.25); // wait half a second
lingye96 1:a95f56d5e053 30 m3pi.stop();
lingye96 1:a95f56d5e053 31 }
lingye96 1:a95f56d5e053 32 if (c =='d')
lingye96 0:48d48099e20c 33 {
lingye96 1:a95f56d5e053 34 m3pi.right(0.5); // Turn left at half speed
lingye96 1:a95f56d5e053 35 wait (0.25); // wait half a second
lingye96 1:a95f56d5e053 36 m3pi.stop();
lingye96 1:a95f56d5e053 37 }
lingye96 1:a95f56d5e053 38 wait (2.0);
lingye96 1:a95f56d5e053 39
lingye96 0:48d48099e20c 40 }
lingye96 0:48d48099e20c 41 }