Hirotaka Yoneda / Mbed 2 deprecated junirobo_sample002

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

Dependencies:   mbed

main.cpp

Committer:
RBH
Date:
2016-10-08
Revision:
0:97ed02705449

File content as of revision 0:97ed02705449:

#include "mbed.h"

DigitalOut Ain1(PA_11); // Aモーター１
DigitalOut Ain2(PC_6);  // Aモーター２
DigitalOut Bin1(PC_8);  // Bモーター１
DigitalOut Bin2(PC_9);  // Bモーター２
DigitalOut sw(D4);      // SW1

void zenshin_A(void);   // Aモーターの前進
void zenshin_B(void);   // Bモーターの前進
void koutai_A(void);    // Aモーターの後退
void koutai_B(void);    // Bモーターの後退
void brake(void);       // ブレーキ

int main(){
    
    while(sw!=1){}      // スイッチを押すとプログラムがスタート
    
    zenshin_A();
    zenshin_B();
    wait(2);
    brake();
}

void zenshin_B(void){
    Bin1 = 1;
    Bin2 = 0;
}
void zenshin_A(void){
    Ain1 = 1;
    Ain2 = 0;
}
void koutai_B(void){
    Bin1 = 0;
    Bin2 = 1;
}
void koutai_A(void){
    Ain1 = 0;
    Ain2 = 1;
}
void brake(void){
    Bin1 = 1;
    Bin2 = 1;
    Ain1 = 1;
    Ain2 = 1;
}