CanSat-C 2021 / Mbed 2 deprecated CanSat-C

Dependencies:   mbed HMC6352 US015 TB6612FNG2 getGPS ATP3011

Committer:
ushiroji
Date:
Sat Oct 23 03:37:21 2021 +0000
Revision:
1:f6d4f374b130
test

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ushiroji 1:f6d4f374b130 1 #include "TB6612.h"
ushiroji 1:f6d4f374b130 2
ushiroji 1:f6d4f374b130 3 TB6612 motor_a(D10,D6,D7); //モータA制御用(pwma,ain1,ain2)
ushiroji 1:f6d4f374b130 4 TB6612 motor_b(D11,D8,D9); //モータB制御用(pwmb,bin1,bin2)
ushiroji 1:f6d4f374b130 5 Serial pc(USBTX, USBRX);
ushiroji 1:f6d4f374b130 6
ushiroji 1:f6d4f374b130 7 void MotorDriver(char input_data, float motor_speed) {
ushiroji 1:f6d4f374b130 8 switch (input_data) {
ushiroji 1:f6d4f374b130 9 case '1': // 停止
ushiroji 1:f6d4f374b130 10 motor_a = 0;
ushiroji 1:f6d4f374b130 11 motor_b = 0;
ushiroji 1:f6d4f374b130 12 break;
ushiroji 1:f6d4f374b130 13 case '2': // 前進
ushiroji 1:f6d4f374b130 14 motor_a = motor_speed;
ushiroji 1:f6d4f374b130 15 motor_b = motor_speed;
ushiroji 1:f6d4f374b130 16 break;
ushiroji 1:f6d4f374b130 17 case '3': // 後退
ushiroji 1:f6d4f374b130 18 motor_a = -motor_speed;
ushiroji 1:f6d4f374b130 19 motor_b = -motor_speed;
ushiroji 1:f6d4f374b130 20 break;
ushiroji 1:f6d4f374b130 21 case '4': // 時計回りに回転
ushiroji 1:f6d4f374b130 22 motor_a = motor_speed;
ushiroji 1:f6d4f374b130 23 motor_b = -motor_speed;
ushiroji 1:f6d4f374b130 24 break;
ushiroji 1:f6d4f374b130 25 case '5': // 反時計回りに回転
ushiroji 1:f6d4f374b130 26 motor_a = -motor_speed;
ushiroji 1:f6d4f374b130 27 motor_b = motor_speed;
ushiroji 1:f6d4f374b130 28 break;
ushiroji 1:f6d4f374b130 29 case '6': // Aのみ正転
ushiroji 1:f6d4f374b130 30 motor_a = motor_speed;
ushiroji 1:f6d4f374b130 31 break;
ushiroji 1:f6d4f374b130 32 case '7': // Bのみ正転
ushiroji 1:f6d4f374b130 33 motor_b = motor_speed;
ushiroji 1:f6d4f374b130 34 break;
ushiroji 1:f6d4f374b130 35 case '8': // Aのみ逆転
ushiroji 1:f6d4f374b130 36 motor_a = -motor_speed;
ushiroji 1:f6d4f374b130 37 break;
ushiroji 1:f6d4f374b130 38 case '9': // Bのみ逆転
ushiroji 1:f6d4f374b130 39 motor_b = -motor_speed;
ushiroji 1:f6d4f374b130 40 break;
ushiroji 1:f6d4f374b130 41 default:
ushiroji 1:f6d4f374b130 42 // エラーメッセージを返す
ushiroji 1:f6d4f374b130 43 break;
ushiroji 1:f6d4f374b130 44 }
ushiroji 1:f6d4f374b130 45 pc.printf("%d", input_data);
ushiroji 1:f6d4f374b130 46 }