this is a sample program being used in KEIHANNA junior robot club

Dependencies:   mbed

Committer:
RBH
Date:
Sat Oct 08 14:35:53 2016 +0000
Revision:
0:97ed02705449
beta

Who changed what in which revision?

UserRevisionLine numberNew 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 }