Ling Ye
/
Serial
bbb
Diff: main.cpp
- Revision:
- 0:48d48099e20c
- Child:
- 1:a95f56d5e053
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main.cpp Tue Nov 01 03:54:17 2016 +0000 @@ -0,0 +1,45 @@ +#include "mbed.h" +#include "m3pi.h" + +m3pi m3pi; +Serial pc(USBTX,USCRX); + +int main() { + + + m3pi.locate(0,1); + m3pi.printf("Serial Control"); + pc.printf("Press 'WASD' to control the m3pi\n"); + + while (1) + { + wait (2.0); + char input = pc.getc(); + if(input=='w') + { + m3pi.forward(0.5); // Forward half speed + wait (0.5); // wait half a second + } + else if (input=='a') + { + m3pi.left(0.5); // Turn left at half speed + wait (0.5); // wait half a second + } + else if (input=='s') + } + m3pi.backward(0.5);// Backward at half speed + wait (0.5); // wait half a second + } + else if (input=='d') + { + m3pi.right(0.5); // Turn right at half speed + wait (0.5); // wait half a second + } + else + { + pc.printf("Try again and press 'WASD' to control the m3pi\n"); + } + m3pi.printf("Complete"); + } + +}