メインコンテンツへスキップ
見出し画像

Arduino Pro Miniを用いたミニ相撲ロボット自立型の基板

     今回は自立型です。ATTinyではGPIOの数が足りないため、Arduino Pro Miniを利用することにします。実装されている部品は全てDIPであるため、万が一壊れた際にも比較的楽に修理を済ませることができます。
     私の基板は自由に利用してください。(但し、いかなる損害・不利益が発生しようとも私は責任を負いません。)


    部品を揃える

     まぁ、適当に。個人が作る場合、モータードライバICとRCYコネクタ付きケーブル(?)、Arduino Pro Mini以外は秋月で買うのが安いと思います。以下、数の記載がないものは、1個です。

    電子部品一覧

    • ユニバーサル基板 3 * 7 (cm)

    • RCYコネクタ付きケーブル:バッテリーとの接続用

    • 三端子レギュレータ NJM7805FA(オーバースペックかな?)

    • セラミックコンデンサ 0.1μF:5個

    • セラミックコンデンサ 0.33μF

    • アルミ電解コンデンサ 470μF:2個

    • ICソケット 8P:2個

    • ICソケット 14P

    • ピンソケット:お好みで。この基板では、モーターとの接続に使います。

    • ピンヘッダー:お好みで。この基板では、センサーとの接続に使います。

    • Arduino Pro Mini(Alixpress, aitendo):3.3V駆動タイプと5V駆動タイプがあるようですね。5Vタイプを前提に説明しますが、レギュレータを変えれば3.3Vでも使えると思います。

    • TA6586/RZ7886(モータードライバIC):2個以上。予備として沢山買っておこう。

    • USB-シリアル変換IC:デバック用。

    • スタートモジュール:こいつがリモコンからの赤外線信号を受信して、Ready - Start - Stop の3段階の状態遷移を制御します。

    • DIPスイッチ 4P:これ安いんですけど、爪で触ると塗装が簡単に剥げてしまうんですよね…

    • その他:配線用の導線には、耐熱電子ワイヤーがオススメです。被覆がはんだごての熱に強く、また曲げやすい硬さです。導線や錫メッキ線は、あまり太いものだとやりにくいです。モーターに大電流が流れるのは一瞬でしょうから、あまり許容電流のことは考えないで、細めのものを選べばいいと思います。安全第一でお願いします。

    電子部品以外に必要なもの

    • 根気:ユニバーサル基板へのはんだづけは疲れる…

    • 電源:はじめのテストは安定化電源で行うこと。基板が正しく動作することが確認できた後は、リポバッテリーで実戦投入だ。

    • リモコン:SONY製のリモコンが必要。Arduinoのライブラリを流用すると、わりと簡単に自作も可能。

    回路図

    画像
    図1 回路図

    基板の図

     USB-シリアル変換ICのモジュールは、秋月のCH340EのモジュールやFT232RQのモジュールがそのまま使えます。

    画像
    図2 ミニ相撲ロボット自立型 基板
    ※1 D10~A3の部分にセンサーを接続します。ピンソケットでも使ってください。
    ※2 DIPスイッチはONになるとGNDとつながります。OFFのときはハイ・インピーダンスになってしまいますから、プログラム側から内部プルアップを有効にしてください。

    プログラム(スケッチ)

    /*
    谷口 左千夫によるミニ相撲ロボット自立型用プログラム
    Arduino Pro Mini使用基板用
    https://note.com/taniguchi_sachio/n/n474cce7dabbc
    ライセンス:CC0
    */
    
    //ピンの指定
    
    //DIPスイッチ
    const int sw1 = 2;
    const int sw2 = 4;
    const int sw3 = 7;
    const int sw4 = 8;
    //モーターA
    const int A_1 = 4;
    const int A_2 = 6;
    //モーターB
    const int B_1 = 3;
    const int B_2 = 9;
    //スタートモジュール
    const int microStartModule = 10;
    //各角度に配置した「JS40F」
    const int leftDistanceSensor = 11;
    const int leftFlontDistanceSensor = 12;
    const int flontDistanceSensor = 13;
    const int rightFlontDistanceSensor = A0;
    const int rightDistanceSensor = A1;
    //底面の右上に配置した「ML1」
    const int leftLineSensor = A2;
    //底面の左上に配置した「ML1」
    const int rightLineSensor = A3;
    
    void setup() {
      //モータードライバICと接続するピンを出力に設定
      pinMode(A_1, OUTPUT);
      pinMode(A_2, OUTPUT);
      pinMode(B_1, OUTPUT);
      pinMode(B_2, OUTPUT);
      //DIPスイッチは内部プルアップを利用する
      pinMode(sw1, INPUT_PULLUP);
      pinMode(sw2, INPUT_PULLUP);
      pinMode(sw3, INPUT_PULLUP);
      pinMode(sw4, INPUT_PULLUP);
      //その他はすべて入力に設定
      for (int i = 10; i <= A7; i++) pinMode(i, INPUT);
    }
    
    void loop() {
      //Ready,Stop時はLOW
      while (microStartModule == LOW)
        ;
      //DIPスイッチの状態
      uint8_t paturn = !digitalRead(sw1) * 8 + !digitalRead(sw2) * 4 + !digitalRead(sw3) * 2 + !digitalRead(sw4) * 1;
      //初めに黒い部分の値を記録する 0.9倍することで誤作動を防ぐ
      int leftLineSensorBlack = analogRead(leftLineSensor) * 0.9;
      int rightLineSensorBlack = analogRead(rightLineSensor) * 0.9;
    
      //パターン
      switch (paturn) {
        //180度旋回(相手に赤外線を吸い取られてしまう場合、180度回転させた状態から始めるよう指示されることがあるため、用意しておくべき)
        case 0b1111:
          motor(-100, 100);
          delay(2000);
          motor(0, 0);
          break;
        //直進
        case 0b0110:
          motor(100, 100);
          delay(5000);
          motor(0, 0);
          break;
        //その他、回り込み等を好みで用意
      }
    
      //Start時はHIGH
      while (microStartModule == HIGH) {
        //ラインセンサーを確認
    
        //両方が白い線に触れたとき
        if (analogRead(leftLineSensor) < leftLineSensorBlack && analogRead(rightLineSensor) < rightLineSensorBlack) {
          //500msバックする
          motor(-100, -100);
          delay(500);
          //2000ms旋回(ロボットの正面を土俵の内側に向ける)
          motor(100, -100);
          delay(2000);
        }
        //左のみ
        else if (analogRead(leftLineSensor) < leftLineSensorBlack && analogRead(rightLineSensor) > rightLineSensorBlack) {
          //500msバックする
          motor(-100, -50);  //右は白い線に触れていないため出力を弱める
          delay(500);
          //2000ms旋回(ロボットの正面を土俵の内側に向ける)
          motor(100, -100);
          delay(2000);
        }
        //右のみ
        else if (analogRead(leftLineSensor) > leftLineSensorBlack && analogRead(rightLineSensor) < rightLineSensorBlack) {
          //500msバックする
          motor(-50, -100);  //右は白い線に触れていないため出力を弱める
          delay(500);
          //2000ms旋回(ロボットの正面を土俵の内側に向ける)
          motor(100, -100);
          delay(2000);
        }
    
        //赤外線センサーを確認
    
        //正面
        else if (digitalRead(leftDistanceSensor)) {
          motor(-100, 100);  //左に曲がる
          delay(1000);
          motor(0, 0);
        } else if (digitalRead(leftFlontDistanceSensor)) {
          motor(-100, 100);  //やや左に曲がる
          delay(500);
          motor(0, 0);
        } else if (digitalRead(flontDistanceSensor)) {
          motor(100, 100);  //直進する
        } else if (digitalRead(rightFlontDistanceSensor)) {
          motor(100, -100);  //やや右に曲がる
          delay(500);
          motor(0, 0);
        } else if (digitalRead(rightDistanceSensor)) {
          motor(100, -100);  //右に曲がる
          delay(1000);
          motor(0, 0);
        }
    
        //相手のロボットを探す動作
        else {
          motor(20, 20);  //ゆっくり直進する
        }
      }
    }
    
    /*
    モーターを制御するための関数
    引数「motorA」「motorB」に-100~100の値を入れることで制御(マイナスなら逆転)
    */
    void motor(int motorA, int motorB) {
      //analogWrite関数の引数は0~255であるため、これに置き換える
      motorA = map(motorA, -100, 100, -255, 255);
      motorB = map(motorB, -100, 100, -255, 255);
      //モーターA
      if (motorA > 0) {
        //正転
        analogWrite(A_1, motorA);
        digitalWrite(A_2, LOW);
      } else if (motorA == 0) {
        //ショートブレーキ
        digitalWrite(A_1, HIGH);
        digitalWrite(A_2, HIGH);
      } else {
        motorA -= motorA;  //0以下の数字であるためマイナスをかけ絶対値にする
        //逆転
        digitalWrite(A_1, LOW);
        analogWrite(A_2, motorA);
      }
      //モーターB
      if (motorB > 0) {
        //正転
        analogWrite(B_1, motorB);
        digitalWrite(B_2, LOW);
      } else if (motorB == 0) {
        //ショートブレーキ
        digitalWrite(B_1, HIGH);
        digitalWrite(B_2, HIGH);
      } else {
        motorB -= motorB;  //0以下の数字であるためマイナスをかけ絶対値にする
        //逆転
        digitalWrite(B_1, LOW);
        analogWrite(B_2, motorB);
      }
    }
    

    ↑トルクを安定させるためにPWM周波数を変える方法については、こちらを参照してください。私は配線のしやすさから、上記のようにモーター制御のピンをD5/D6, D3/D9としましたが、そうではなくて、D9/D10(Timer1), D3/D11(Timer2)にする必要がありそうですね。D5, D6はTimer0で、これのPWM周波数を変えてしまうとdelay()やmillis()が正しく動作しなくなってしまう恐れがあります。

    性能比較

     この基板を、日本の大会でよく使われる2つの基板(Cytron製とJsumo製)と比較してみましょう。

    Cytron : MAKER-MSUMO

    • 入力電圧:7~18V

    • 出力電流:連続3A, ピーク時6A

    • サイズ:91.44 * 35.56 mm

    • DIPスイッチ:3P(8パターン)

    • 価格: 27.25 USD(2025.04.21現在 約4000円)

    Jsumo : XMotion All In One Controller V3

    • 入力電圧:7~28V

    • 出力電流:6A

    • サイズ:80 * 30 mm

    • DIPスイッチ:3P(8パターン)

    • 価格:64 USD(2025.04.21現在 約9,000円)

    この基板(モタドラにRZ7886を使用した場合)

    • 入力電圧:7~15V

    • 出力電流:13A

    • サイズ:70 * 30 mm

    • DIPスイッチ:4P(16パターン)

    • 価格:2000円未満(USB-シリアル変換モジュール, 錫メッキ線, 耐熱電子ワイヤー等を除く)

    結果

     この基板は自立型に必要な最小限の機能しか実装されていません。一方、CytronやJsumo製の基板には加えて様々な機能が搭載されているため、フェアな比較とはなりません。
     しかしながら、出力電流とサイズの分野では、この基板が圧倒的に上回っています!一つネックになっているのは、入力電圧ですね。絶対最大定格で、15Vですから… 4S(3.7V * 4S = 14.8V, 4.2V * 4S = 16.8V)はちょっと怖い。
     最も使われているであろうモーターの一つ、JsumoのCore DC Motorの750RPMタイプは停止電流が3.5Aです。これに3Sや4Sを加えたときのことを考えると、電圧に停止電流は比例するとして、

    3Sならば
    4.2V * 3S / 6V * 3.5A = 7.35A
    4Sならば
    4.2V * 4S / 6V * 3.5A = 9.8A

    となるでしょう。つまり、この時点でCytron製もJsumo製も、(仮にこの単純な計算が正しいとしたら)アウトです。必要とされる電流を出しきれません。フッ…勝ったな!
     モーターの性能を出し切りたい、あるいは基板のサイズによる機体の設計に対する制約を少しでも拭いたい、そして何より費用を抑えたいのであれば、是非とも私の基板をパクってください!

    参考

     
     
    当アカウントの記事にはアフィリエイトリンクが含まれています。 趣味の電子工作や、ロボット競技への出場経験を基に記事を書きます。 不安定な精神状態で書いた文章ばかりで飛躍が多い ヒステリイの山犬よ 石油の空缶を早く乱打しろ! そして幕をあげろ!! ハッシュ!! ハッショ!!

    あなたへのおすすめ