CanSat2016aizu
/
motor_test
motor
main.cpp@1:6ad72ace0fec, 2016-07-19 (annotated)
- Committer:
- s1210160
- Date:
- Tue Jul 19 03:51:28 2016 +0000
- Revision:
- 1:6ad72ace0fec
- Parent:
- 0:974de11b1491
- Child:
- 2:b7676b0b020e
motor test;
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
s1210160 | 0:974de11b1491 | 1 | #include "mbed.h" |
s1210160 | 0:974de11b1491 | 2 | #include "VNH5019.h" |
s1210160 | 0:974de11b1491 | 3 | |
s1210160 | 0:974de11b1491 | 4 | VNH5019 motorShield(p23,p22,p25,p21,p24,p26); |
s1210160 | 0:974de11b1491 | 5 | Serial pc(USBTX, USBRX); |
s1210160 | 0:974de11b1491 | 6 | Serial xbee(p13, p14); |
s1210160 | 0:974de11b1491 | 7 | |
s1210160 | 0:974de11b1491 | 8 | int main() |
s1210160 | 0:974de11b1491 | 9 | { |
s1210160 | 1:6ad72ace0fec | 10 | xbee.baud(57600); |
s1210160 | 1:6ad72ace0fec | 11 | pc.baud(57600); |
s1210160 | 0:974de11b1491 | 12 | |
s1210160 | 0:974de11b1491 | 13 | char c; |
s1210160 | 0:974de11b1491 | 14 | |
s1210160 | 0:974de11b1491 | 15 | while(true) { |
s1210160 | 0:974de11b1491 | 16 | c = xbee.getc(); |
s1210160 | 0:974de11b1491 | 17 | |
s1210160 | 1:6ad72ace0fec | 18 | // front |
s1210160 | 0:974de11b1491 | 19 | if(c == 'f') { |
s1210160 | 1:6ad72ace0fec | 20 | xbee.printf("f\n"); |
s1210160 | 1:6ad72ace0fec | 21 | motorShield.changeSpeed(1, 64, 1, 64); |
s1210160 | 0:974de11b1491 | 22 | } |
s1210160 | 0:974de11b1491 | 23 | |
s1210160 | 1:6ad72ace0fec | 24 | // back |
s1210160 | 0:974de11b1491 | 25 | if(c == 'b'){ |
s1210160 | 1:6ad72ace0fec | 26 | xbee.printf("b\n"); |
s1210160 | 1:6ad72ace0fec | 27 | motorShield.changeSpeed(2, 64, 2, 64); |
s1210160 | 0:974de11b1491 | 28 | } |
s1210160 | 0:974de11b1491 | 29 | |
s1210160 | 1:6ad72ace0fec | 30 | // left |
s1210160 | 0:974de11b1491 | 31 | if(c == 'l'){ |
s1210160 | 1:6ad72ace0fec | 32 | xbee.printf("l\n"); |
s1210160 | 1:6ad72ace0fec | 33 | motorShield.changeSpeed(0, 64, 1, 64); |
s1210160 | 0:974de11b1491 | 34 | } |
s1210160 | 0:974de11b1491 | 35 | |
s1210160 | 1:6ad72ace0fec | 36 | // right |
s1210160 | 0:974de11b1491 | 37 | if(c == 'r') { |
s1210160 | 1:6ad72ace0fec | 38 | xbee.printf("r\n"); |
s1210160 | 1:6ad72ace0fec | 39 | motorShield.changeSpeed(1, 64, 0, 64); |
s1210160 | 0:974de11b1491 | 40 | } |
s1210160 | 0:974de11b1491 | 41 | |
s1210160 | 1:6ad72ace0fec | 42 | // stop |
s1210160 | 0:974de11b1491 | 43 | if(c == 's') { |
s1210160 | 1:6ad72ace0fec | 44 | xbee.printf("s\n"); |
s1210160 | 1:6ad72ace0fec | 45 | motorShield.changeSpeed(0, 64, 0, 64); |
s1210160 | 0:974de11b1491 | 46 | } |
s1210160 | 0:974de11b1491 | 47 | } |
s1210160 | 0:974de11b1491 | 48 | return 0; |
s1210160 | 0:974de11b1491 | 49 | } |