electronics-lab / Mbed 2 deprecated 380K75moter

Cansatモータテスト用です。

Dependencies:   mbed

main.cpp

Committer:
ponpoko1939
Date:
2018-08-10
Revision:
0:b7ec2678555c

File content as of revision 0:b7ec2678555c:

#include "mbed.h"

DigitalOut motor1(p21);
DigitalOut motor2(p22);
DigitalOut motor3(p23);
DigitalOut motor4(p24);

void Brake();
void Turn();
void Return();
void Right();
void Left();

int main() {
    while(1) {
        Turn();
        wait(3);
        Return();
        wait(3);
        Right();
        wait(3);
        Left();
        wait(3);
        Breky();
        wait(3);
    }
}

void Breky(){
    motor1 = 0;
    motor2 = 0;
    motor3 = 0;
    motor4 = 0;    
}

void Turn(){
    motor1 = 1;
    motor2 = 0; 
    motor3 = 1;
    motor4 = 0;     
}

void Return(){
    motor1 = 0;
    motor2 = 1;
    motor3 = 0;
    motor4 = 1;      
}

void Left(){
    motor1 = 1;
    motor2 = 0;
    motor3 = 0;
    motor4 = 1;      
}

void Right(){
    motor1 = 0;
    motor2 = 1;
    motor3 = 1;
    motor4 = 0;      
}