2018-10-29
砲撃時のリコイルアクション+LED点灯、銃撃時のLED点滅(5回)の機能を追加しました。
残念ながら、現在のシステムでは出力ピンの空きは3から9までの7個です。
DCモータ1個に+、-、PWMの3個が2セットで6個と、LEDに1個で残りゼロです。
砲塔旋回、砲身上下などの機能を追加するにはどうするか?
Arduino PS3 Bluetooth controlled tank ver.2
【使用パーツ】
1.Aruduino UNO R3(ELEGOO)
2.USBホストシールド 2.0 for Arduino(互換品)
3.KKHMF デュアル・モータードライバ モジュール TB6612FNG
4.DD昇圧コンバータ(IN:DC3V / OUT:DC5V):100均モバイルバッテリから移植
モータドライブ用電源に使用
5.Lipoバッテリ DC3.7V 350mAh(DD昇圧コンバータ用)
6.006Pアルカリ電池(Arduino外部電源用)
7.タミヤ タンク工作基本セット[70108]
8.タミヤ ツインモーターギヤーボックス [70097]
9.タミヤ ユニバーサルプレートセット [70098]
(注意)DC5Vコンバータ出力電流値は0.8A(実測)でした。
100均のモバイルバッテリのDDコンバータの使用は自己責任です。
【直近の問題点】
1.006Pアルカリ電池はもったいないので、他の電源供給方法を検討したい。
この電圧が6Vまで下がってくると暴走します。
2018-10-30
009Pアルカリ電池の代替案を実施。
容量不足で使わなかったDDコンバータを使い、同じ3.7VのLipoバッテリからモータ用とは別のコンバータで5Vを作成。
Arduino外部入力(Vin)へ接続します。(実測電流値0.1A以下)
コンバータを分けることで、モータ駆動時のラッシュ電流などで5Vが一瞬低下してArduinoが動作不良するのを回避します。
動作テストの結果も良好なので、この方法で解決です。(100μFコンデンサ実装だけでは回避できない)
【ver.2のスケッチ】
PS3BT_arduino_tank_2dcmotor_TB6612
モータドライバはTB6612
サーボモータを動かす Ver.2
*/
#include <usbhub.h>
#ifdef dobogusinclude
#include <spi4teensy3.h>
#endif
int val = 0;
int pos_y;
int pos_x;
int PWMA = 5; // ← 11 Aモータ PWM 左側モータ
int AIN1 = 4; // ← 9 Aモータ IN1 ( 9ピンはUSBホストシールド使用
int AIN2 = 2; // ← 8 Aモータ IN2
int BIN1 = 8; // ← 7 Bモータ IN1
int BIN2 = 7; // ← 6 Bモータ IN2
int PWMB = 6; // ← 10 Bモータ PWM 右側モータ ( 10ピンはUSBホストシールド使用
int motor_speed;
const int motor_sp1 = 128; //超信地旋回速度
const int motor_sp0 = 255; //超高速
BTD Btd(&Usb); //そうしたBluetooth Dongleの事例を作成する必要があります
PS3BT PS3(&Btd); //これで事例が作成されます
//PS3BT PS3(&Btd, 0x00, 0x15, 0x83, 0x3D, 0x0A, 0x57);
// これにはBluetoothアドレスも格納されます
// これはスケッチを実行するときにドングルから取得できます
pinMode(PWMA, OUTPUT);
pinMode(AIN1, OUTPUT);
pinMode(AIN2, OUTPUT);
pinMode(BIN1, OUTPUT);
pinMode(BIN2, OUTPUT);
pinMode(PWMB, OUTPUT);
pinMode(LED, OUTPUT);
while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection
if (Usb.Init() == -1) {
Serial.print(F("\r\nOSC did not start"));
while (1); //halt
}
Serial.print(F("\r\nPS3 Bluetooth Library Started"));
}
Usb.Task();
if (PS3.PS3Connected) {
//スティックの中央は127だけどピタリと止まらないので+-10ほど余裕を持たせる。
//左スティック上下の値(最上部0、中央127、最下部255)を読み込む
pos_y = PS3.getAnalogHat(LeftHatY);
pos_x = PS3.getAnalogHat(LeftHatX);
//リコイル
if (PS3.getButtonClick(R1) ) {
Serial.println("FIRE");
digitalWrite(LED, HIGH);
digitalWrite(AIN1, LOW);
digitalWrite(AIN2, HIGH);
analogWrite(PWMA, motor_sp0);
digitalWrite(BIN1, LOW);
digitalWrite(BIN2, HIGH);
analogWrite(PWMB, motor_sp0);
delay(70);
digitalWrite(LED, LOW);
digitalWrite(AIN1, HIGH);
digitalWrite(AIN2, LOW);
analogWrite(PWMA, motor_sp1);
digitalWrite(BIN1, HIGH);
digitalWrite(BIN2, LOW);
analogWrite(PWMB, motor_sp1);
delay(95);
}
if ( PS3.getButtonClick(L1)) {
for ( int i = 0; i < 5 ; i++) {
val++;
Serial.print("L1 : ");
Serial.println(PS3.getButtonClick(L1));
Serial.println("DA ");
Serial.println(val);
digitalWrite(LED, HIGH);
delay(50);
digitalWrite(LED, LOW);
delay(50);
Serial.println("");
}
}
if (pos_x >= 117 && pos_x <= 137 && pos_y >= 117 && pos_y <= 137) {
analogWrite(PWMA, 0);
digitalWrite(AIN1, LOW);
digitalWrite(AIN2, LOW);
analogWrite(PWMA, 0);
digitalWrite(BIN1, LOW);
digitalWrite(BIN2, LOW);
}
else if (pos_y < 117 && pos_x > 117 && pos_x < 137) {
//左スティック中央(127)から最上部(0)の値をモーターのスピード0から255に変換
motor_speed = map(pos_y, 117, 0, 0, 255);
digitalWrite(AIN1, HIGH);
digitalWrite(AIN2, LOW);
analogWrite(PWMA, motor_speed);
digitalWrite(BIN1, HIGH);
digitalWrite(BIN2, LOW);
analogWrite(PWMB, motor_speed);
}
else if ( pos_y > 137 && pos_x > 117 && pos_x < 137) {
motor_speed = map(pos_y, 137, 255, 0, 255);
digitalWrite(AIN1, LOW);
digitalWrite(AIN2, HIGH);
analogWrite(PWMA, motor_speed);
digitalWrite(BIN1, LOW);
digitalWrite(BIN2, HIGH);
analogWrite(PWMB, motor_speed);
}
else if ( pos_y < 117 && pos_x > 137) {
motor_speed = map(pos_y, 117, 0, 0, 255);
digitalWrite(AIN1, HIGH);
digitalWrite(AIN2, LOW);
analogWrite(PWMA, motor_speed);
digitalWrite(BIN1, LOW);
digitalWrite(BIN2, LOW);
analogWrite(PWMB, motor_speed);
}
else if ( pos_y < 117 && pos_x < 117) {
motor_speed = map(pos_y, 117, 0, 0, 255);
digitalWrite(AIN1, LOW);
digitalWrite(AIN2, LOW);
analogWrite(PWMA, motor_speed);
digitalWrite(BIN1, HIGH);
digitalWrite(BIN2, LOW);
analogWrite(PWMB, motor_speed);
}
else if ( pos_y > 137 && pos_x > 137) {
motor_speed = map(pos_y, 137, 255, 0, 255);
digitalWrite(AIN1, LOW);
digitalWrite(AIN2, HIGH);
analogWrite(PWMA, motor_speed);
digitalWrite(BIN1, LOW);
digitalWrite(BIN2, LOW);
analogWrite(PWMB, motor_speed);
}
else if ( pos_y > 137 && pos_x < 117) {
motor_speed = map(pos_y, 117, 0, 0, 255);
digitalWrite(AIN1, LOW);
digitalWrite(AIN2, LOW);
analogWrite(PWMA, motor_speed);
digitalWrite(BIN1, LOW);
digitalWrite(BIN2, HIGH);
analogWrite(PWMB, motor_speed);
}
else if ( pos_y > 117 && pos_y < 137 && pos_x > 137) {
digitalWrite(AIN1, HIGH);
digitalWrite(AIN2, LOW);
analogWrite(PWMA, motor_sp1);
digitalWrite(BIN1, LOW);
digitalWrite(BIN2, HIGH);
analogWrite(PWMB, motor_sp1);
}
else if ( pos_y > 117 && pos_y < 137 && pos_x < 117) {
digitalWrite(AIN1, LOW);
digitalWrite(AIN2, HIGH);
analogWrite(PWMA, motor_sp1);
digitalWrite(BIN1, HIGH);
digitalWrite(BIN2, LOW);
analogWrite(PWMB, motor_sp1);
}
}
}