Ling Ye
/
test1
bbb
Fork of Serial by
main.cpp@1:a95f56d5e053, 2016-11-02 (annotated)
- Committer:
- lingye96
- Date:
- Wed Nov 02 19:44:07 2016 +0000
- Revision:
- 1:a95f56d5e053
- Parent:
- 0:48d48099e20c
asdf
Who changed what in which revision?
User | Revision | Line number | New 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 | } |