プロジェクト15: 最終的な完全機能プロジェクト

テストコード

/*
 keyestudio Mini Tank Robot V2.1
 lesson 15
 bluetooth tank
 http://www.keyestudio.com
*/

//配列、パターンのデータを保存するために使用されます。自分で計算するか、モジュラスツールから取得できます
unsigned char start01[] = {0x01,0x02,0x04,0x08,0x10,0x20,0x40,0x80,0x80,0x40,0x20,0x10,0x08,0x04,0x02,0x01};
unsigned char front[] = {0x00,0x00,0x00,0x00,0x00,0x24,0x12,0x09,0x12,0x24,0x00,0x00,0x00,0x00,0x00,0x00};
unsigned char back[] = {0x00,0x00,0x00,0x00,0x00,0x24,0x48,0x90,0x48,0x24,0x00,0x00,0x00,0x00,0x00,0x00};
unsigned char left[] = {0x00,0x00,0x00,0x00,0x00,0x00,0x44,0x28,0x10,0x44,0x28,0x10,0x44,0x28,0x10,0x00};
unsigned char right[] = {0x00,0x10,0x28,0x44,0x10,0x28,0x44,0x10,0x28,0x44,0x00,0x00,0x00,0x00,0x00,0x00};
unsigned char STOP01[] = {0x2E,0x2A,0x3A,0x00,0x02,0x3E,0x02,0x00,0x3E,0x22,0x3E,0x00,0x3E,0x0A,0x0E,0x00};
unsigned char clear[] = {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00};
#define SCL_Pin  A5  //クロックピンをA5に設定
#define SDA_Pin  A4  //データピンをA4に設定

#define ML_Ctrl 13  //左モーターの方向制御ピンを定義
#define ML_PWM 11   //左モーターのPWM制御ピンを定義
#define MR_Ctrl 12  //右モーターの方向制御ピンを定義
#define MR_PWM 3    //右モーターのPWM制御ピンを定義

char bluetooth_val; //Bluetooth受信値を保存

void setup()
{
  Serial.begin(9600);
  
  pinMode(SCL_Pin,OUTPUT);
  pinMode(SDA_Pin,OUTPUT);
  matrix_display(clear);    //ディスプレイをクリア
  matrix_display(start01);  //スタートパターンを表示

  pinMode(ML_Ctrl, OUTPUT);
  pinMode(ML_PWM, OUTPUT);
  pinMode(MR_Ctrl, OUTPUT);
  pinMode(MR_PWM, OUTPUT);
}

void loop()
{
  if (Serial.available())
  {
    bluetooth_val = Serial.read();
    Serial.println(bluetooth_val);
  }
  switch (bluetooth_val) 
  {
     case 'F':  //前進コマンド
        Car_front();
        matrix_display(front);  //前進デザインを表示
        break;
     case 'B':  //後進コマンド
        Car_back();
        matrix_display(back);  //後進パターンを表示
        break;
     case 'L':  //左旋回指示
        Car_left();
        matrix_display(left);  //「左旋回」サインを表示
        break;
     case 'R':  //右旋回指示
        Car_right();
        matrix_display(right);  //右旋回サインを表示
        break;
     case 'S':  //停止コマンド
        Car_Stop();
        matrix_display(STOP01);  //停止画像を表示
        break;
  }
}

/**************ドットマトリックスの機能****************/
//この関数はドットマトリックス表示に使用されます
void matrix_display(unsigned char matrix_value[])
{
  IIC_start();
  IIC_send(0xc0);  //アドレスを選択
  
  for(int i = 0;i < 16;i++) //パターンデータは16ビット
  {
     IIC_send(matrix_value[i]); //パターンを伝達するデータ
  }
  IIC_end();   //データパターン伝達を終了
  
  IIC_start();
  IIC_send(0x8A);  //表示制御、パルス幅を4/16に設定
  IIC_end();
}
//データ伝達を開始する条件
void IIC_start()
{
  digitalWrite(SCL_Pin,HIGH);
  delayMicroseconds(3);
  digitalWrite(SDA_Pin,HIGH);
  delayMicroseconds(3);
  digitalWrite(SDA_Pin,LOW);
  delayMicroseconds(3);
}
//データを伝達
void IIC_send(unsigned char send_data)
{
  for(char i = 0;i < 8;i++)  //各バイトは8ビット
  {
      digitalWrite(SCL_Pin,LOW);  //クロックピンSCL_Pinを下げてSDAの信号を変更
      delayMicroseconds(3);
      if(send_data & 0x01)  //各ビットの1または0に従ってSDA_Pinの高低レベルを設定
      {
        digitalWrite(SDA_Pin,HIGH);
      }
      else
      {
        digitalWrite(SDA_Pin,LOW);
      }
      delayMicroseconds(3);
      digitalWrite(SCL_Pin,HIGH); //クロックピンSCL_Pinを上げてデータ伝達を停止
      delayMicroseconds(3);
      send_data = send_data >> 1;  //ビットごとに検出するため、データを1ビット右にシフト
  }
}
//データ伝達が終了したサイン
void IIC_end()
{
  digitalWrite(SCL_Pin,LOW);
  delayMicroseconds(3);
  digitalWrite(SDA_Pin,LOW);
  delayMicroseconds(3);
  digitalWrite(SCL_Pin,HIGH);
  delayMicroseconds(3);
  digitalWrite(SDA_Pin,HIGH);
  delayMicroseconds(3);
}
/*************モーターを実行する機能**************/
void Car_front()
{
  digitalWrite(MR_Ctrl,LOW);
  analogWrite(MR_PWM,200);
  digitalWrite(ML_Ctrl,LOW);
  analogWrite(ML_PWM,200);
}
void Car_back()
{
  digitalWrite(MR_Ctrl,HIGH);
  analogWrite(MR_PWM,200);
  digitalWrite(ML_Ctrl,HIGH);
  analogWrite(ML_PWM,200);
}
void Car_left()
{
  digitalWrite(MR_Ctrl,LOW);
  analogWrite(MR_PWM,255);
  digitalWrite(ML_Ctrl,HIGH);
  analogWrite(ML_PWM,255);
}
void Car_right()
{
  digitalWrite(MR_Ctrl,HIGH);
  analogWrite(MR_PWM,255);
  digitalWrite(ML_Ctrl,LOW);
  analogWrite(ML_PWM,255);
}
void Car_Stop()
{
  digitalWrite(MR_Ctrl,LOW);
  analogWrite(MR_PWM,0);
  digitalWrite(ML_Ctrl,LOW);
  analogWrite(ML_PWM,0);
}
void Car_T_left()
{
  digitalWrite(MR_Ctrl,LOW);
  analogWrite(MR_PWM,255);
  digitalWrite(ML_Ctrl,LOW);
  analogWrite(ML_PWM,180);
}
void Car_T_right()
{
  digitalWrite(MR_Ctrl,LOW);
  analogWrite(MR_PWM,180);
  digitalWrite(ML_Ctrl,LOW);
  analogWrite(ML_PWM,255);
}

テスト結果

**注意: **テストコードをアップロードする前にBluetoothモジュールを取り外してください。そうしないとテストコードのアップロードに失敗します。テストコードをアップロードした後、Bluetoothモジュールを再度接続してください

テストコードが正常にアップロードされたら、Bluetoothモジュールを挿入し、電源を入れてBluetoothに接続してください。タンクロボットはアプリで明確な機能を表示できます。

以上で、すべてのプロジェクトが完了しました。問題が発生した場合は、お気軽にお問い合わせください。