Hirotaka Yoneda
/
junirobo_sample002
this is a sample program being used in KEIHANNA junior robot club
main.cpp@0:97ed02705449, 2016-10-08 (annotated)
- Committer:
- RBH
- Date:
- Sat Oct 08 14:35:53 2016 +0000
- Revision:
- 0:97ed02705449
beta
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
RBH | 0:97ed02705449 | 1 | #include "mbed.h" |
RBH | 0:97ed02705449 | 2 | |
RBH | 0:97ed02705449 | 3 | DigitalOut Ain1(PA_11); // Aモーター1 |
RBH | 0:97ed02705449 | 4 | DigitalOut Ain2(PC_6); // Aモーター2 |
RBH | 0:97ed02705449 | 5 | DigitalOut Bin1(PC_8); // Bモーター1 |
RBH | 0:97ed02705449 | 6 | DigitalOut Bin2(PC_9); // Bモーター2 |
RBH | 0:97ed02705449 | 7 | DigitalOut sw(D4); // SW1 |
RBH | 0:97ed02705449 | 8 | |
RBH | 0:97ed02705449 | 9 | void zenshin_A(void); // Aモーターの前進 |
RBH | 0:97ed02705449 | 10 | void zenshin_B(void); // Bモーターの前進 |
RBH | 0:97ed02705449 | 11 | void koutai_A(void); // Aモーターの後退 |
RBH | 0:97ed02705449 | 12 | void koutai_B(void); // Bモーターの後退 |
RBH | 0:97ed02705449 | 13 | void brake(void); // ブレーキ |
RBH | 0:97ed02705449 | 14 | |
RBH | 0:97ed02705449 | 15 | int main(){ |
RBH | 0:97ed02705449 | 16 | |
RBH | 0:97ed02705449 | 17 | while(sw!=1){} // スイッチを押すとプログラムがスタート |
RBH | 0:97ed02705449 | 18 | |
RBH | 0:97ed02705449 | 19 | zenshin_A(); |
RBH | 0:97ed02705449 | 20 | zenshin_B(); |
RBH | 0:97ed02705449 | 21 | wait(2); |
RBH | 0:97ed02705449 | 22 | brake(); |
RBH | 0:97ed02705449 | 23 | } |
RBH | 0:97ed02705449 | 24 | |
RBH | 0:97ed02705449 | 25 | void zenshin_B(void){ |
RBH | 0:97ed02705449 | 26 | Bin1 = 1; |
RBH | 0:97ed02705449 | 27 | Bin2 = 0; |
RBH | 0:97ed02705449 | 28 | } |
RBH | 0:97ed02705449 | 29 | void zenshin_A(void){ |
RBH | 0:97ed02705449 | 30 | Ain1 = 1; |
RBH | 0:97ed02705449 | 31 | Ain2 = 0; |
RBH | 0:97ed02705449 | 32 | } |
RBH | 0:97ed02705449 | 33 | void koutai_B(void){ |
RBH | 0:97ed02705449 | 34 | Bin1 = 0; |
RBH | 0:97ed02705449 | 35 | Bin2 = 1; |
RBH | 0:97ed02705449 | 36 | } |
RBH | 0:97ed02705449 | 37 | void koutai_A(void){ |
RBH | 0:97ed02705449 | 38 | Ain1 = 0; |
RBH | 0:97ed02705449 | 39 | Ain2 = 1; |
RBH | 0:97ed02705449 | 40 | } |
RBH | 0:97ed02705449 | 41 | void brake(void){ |
RBH | 0:97ed02705449 | 42 | Bin1 = 1; |
RBH | 0:97ed02705449 | 43 | Bin2 = 1; |
RBH | 0:97ed02705449 | 44 | Ain1 = 1; |
RBH | 0:97ed02705449 | 45 | Ain2 = 1; |
RBH | 0:97ed02705449 | 46 | } |