Cansatモータテスト用です。
Dependencies: mbed
main.cpp@0:b7ec2678555c, 2018-08-10 (annotated)
- Committer:
- ponpoko1939
- Date:
- Fri Aug 10 10:53:13 2018 +0000
- Revision:
- 0:b7ec2678555c
Cansat???????
Who changed what in which revision?
User | Revision | Line number | New 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 | } |