Cansatモータテスト用です。

Dependencies:   mbed

Committer:
ponpoko1939
Date:
Fri Aug 10 10:53:13 2018 +0000
Revision:
0:b7ec2678555c
Cansat???????

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ponpoko1939 0:b7ec2678555c 1 #include "mbed.h"
ponpoko1939 0:b7ec2678555c 2
ponpoko1939 0:b7ec2678555c 3 DigitalOut motor1(p21);
ponpoko1939 0:b7ec2678555c 4 DigitalOut motor2(p22);
ponpoko1939 0:b7ec2678555c 5 DigitalOut motor3(p23);
ponpoko1939 0:b7ec2678555c 6 DigitalOut motor4(p24);
ponpoko1939 0:b7ec2678555c 7
ponpoko1939 0:b7ec2678555c 8 void Brake();
ponpoko1939 0:b7ec2678555c 9 void Turn();
ponpoko1939 0:b7ec2678555c 10 void Return();
ponpoko1939 0:b7ec2678555c 11 void Right();
ponpoko1939 0:b7ec2678555c 12 void Left();
ponpoko1939 0:b7ec2678555c 13
ponpoko1939 0:b7ec2678555c 14 int main() {
ponpoko1939 0:b7ec2678555c 15 while(1) {
ponpoko1939 0:b7ec2678555c 16 Turn();
ponpoko1939 0:b7ec2678555c 17 wait(3);
ponpoko1939 0:b7ec2678555c 18 Return();
ponpoko1939 0:b7ec2678555c 19 wait(3);
ponpoko1939 0:b7ec2678555c 20 Right();
ponpoko1939 0:b7ec2678555c 21 wait(3);
ponpoko1939 0:b7ec2678555c 22 Left();
ponpoko1939 0:b7ec2678555c 23 wait(3);
ponpoko1939 0:b7ec2678555c 24 Breky();
ponpoko1939 0:b7ec2678555c 25 wait(3);
ponpoko1939 0:b7ec2678555c 26 }
ponpoko1939 0:b7ec2678555c 27 }
ponpoko1939 0:b7ec2678555c 28
ponpoko1939 0:b7ec2678555c 29 void Breky(){
ponpoko1939 0:b7ec2678555c 30 motor1 = 0;
ponpoko1939 0:b7ec2678555c 31 motor2 = 0;
ponpoko1939 0:b7ec2678555c 32 motor3 = 0;
ponpoko1939 0:b7ec2678555c 33 motor4 = 0;
ponpoko1939 0:b7ec2678555c 34 }
ponpoko1939 0:b7ec2678555c 35
ponpoko1939 0:b7ec2678555c 36 void Turn(){
ponpoko1939 0:b7ec2678555c 37 motor1 = 1;
ponpoko1939 0:b7ec2678555c 38 motor2 = 0;
ponpoko1939 0:b7ec2678555c 39 motor3 = 1;
ponpoko1939 0:b7ec2678555c 40 motor4 = 0;
ponpoko1939 0:b7ec2678555c 41 }
ponpoko1939 0:b7ec2678555c 42
ponpoko1939 0:b7ec2678555c 43 void Return(){
ponpoko1939 0:b7ec2678555c 44 motor1 = 0;
ponpoko1939 0:b7ec2678555c 45 motor2 = 1;
ponpoko1939 0:b7ec2678555c 46 motor3 = 0;
ponpoko1939 0:b7ec2678555c 47 motor4 = 1;
ponpoko1939 0:b7ec2678555c 48 }
ponpoko1939 0:b7ec2678555c 49
ponpoko1939 0:b7ec2678555c 50 void Left(){
ponpoko1939 0:b7ec2678555c 51 motor1 = 1;
ponpoko1939 0:b7ec2678555c 52 motor2 = 0;
ponpoko1939 0:b7ec2678555c 53 motor3 = 0;
ponpoko1939 0:b7ec2678555c 54 motor4 = 1;
ponpoko1939 0:b7ec2678555c 55 }
ponpoko1939 0:b7ec2678555c 56
ponpoko1939 0:b7ec2678555c 57 void Right(){
ponpoko1939 0:b7ec2678555c 58 motor1 = 0;
ponpoko1939 0:b7ec2678555c 59 motor2 = 1;
ponpoko1939 0:b7ec2678555c 60 motor3 = 1;
ponpoko1939 0:b7ec2678555c 61 motor4 = 0;
ponpoko1939 0:b7ec2678555c 62 }