HumansXドキュメントセンター 公式サイトへ ↗

実験9 四輪駆動・四輪全方向メカナムホイールロボットの追従機能

実験の目的:

  1. 条件判断ブロックを使用できるようになる。2. 超音波センサーの動作原理に基づいて、ロボットの目標追従機能を実現する。

機能要件:

ロボットが目標を追従します。目標を検出した状態で、目標が左に曲がるとロボットも左に曲がり、目標が右に曲がるとロボットも右に曲がります。

ハードウェアの準備:

機器名 数量 備考
ESP32 メインボード 1 枚 コア制御ユニット
Type-C データケーブル 1 本 PC に接続してプログラムを書き込む
2S バッテリーボックス + リチウム電池 1 セット モーターに電源を供給(モーターの定格電圧に適合)
超音波センサー 2 距離を検出するセンサー

試作方案:

本実験では四輪四駆メカナムホイールシャーシをロボット本体として使用します。以下のリンクを参照してください。

リンク

回路接続:

ハードウェアモジュール

番号 リンク 重要度 役割
1 Uni ESP32 メインボードおよび拡張ボードの説明【V3.0】​ 必読 開発ボードのインターフェースをすばやく確認できます。
2 バッテリーモジュールの使用(必読)​ 必読 バッテリーの取り付け、接続、充電方法をすばやく理解できます。
3 OpenBlock ソフトウェア環境の設定と使用【V3.0】 必読 ソフトウェアの概要、インストール、基本的な使い方を理解できます。
4 電子モジュールの紹介 必要に応じて リンクをクリックして DC モーター(TT モーター)、超音波モジュール を確認してください

ピンの説明

ハードウェア ESP32 ピン
モーター 1 13, 27
モーター 2 14, 25
モーター 3 26, 32
モーター 4 18, 19
超音波センサー TRIG:0 ECHO:2
超音波センサー TRIG:15 ECHO:12

実物の配線

ソフトウェア設計

ソースコードのダウンロード

四駆四輪全方向メカナムホイールロボット 追従.rar

ブロックコード

操作手順:

  1. グラフィカルプログラムをダウンロードします。ESP32 のバージョンを選択し、ESP32 ボードを PC の USB ポートに挿してから、接続してプログラムを書き込みます。

  2. スイッチを入れて実行し、動作を確認します。

実験結果:

​ロボットが目標を追従します。目標を検出した状態で、目標が左に曲がるとロボットも左に曲がり、目標が右に曲がるとロボットも右に曲がります。

具体的な動作:

2 つの超音波センサーが検出した距離が 60cm 未満になると、「追従」モードを開始します。

2 つの超音波センサーが検出した距離が 30cm 未満の場合は、衝突を防ぐために移動を停止します。

目標が右側にある場合、ロボットは右に移動して追従します。

目標が左側にある場合、ロボットは左に移動して追従します。

それ以外の場合は前進します。