Arduino Nano と OpenCV で実現する自律顔追跡ロボットカー
概要
Creator Ci20(または Raspberry Pi 等の Linux ボード)上で OpenCV + Python を用いて顔検出を行い、Arduino Nano 経由でサーボ・モーターを制御して顔を追跡するロボットカーの製作記事です。USB カメラ、超音波距離センサー、L298 モータードライバーを搭載し、顔位置に合わせてパン/チルト・前進/後退/旋回を行います。
システム構成
- ビジョン側(Ci20 / Linux): OpenCV 2.4.9、Python、
haarcascade_frontalface_alt.xmlで顔検出 → 顔の中心座標を算出 → シリアル(115200 bps)で Arduino へサーボ角度・走行指令送信 - 制御側(Arduino Nano): 受信コマンドに基づき、パン/チルトサーボ(MG996R ×2)制御、L298 で 4 輪 DC モーター駆動、HC-SR04 で障害物距離測定・衝突回避
必要なハードウェア
| 部品 | 数量 | 備考 |
|---|---|---|
| Creator Ci20(または Raspberry Pi 3/4 等) | 1 | Debian 8 等 Linux 稼働、USB カメラ接続可能 |
| Arduino Nano R3 | 1 | サーボ・モーター制御用 |
| SparkFun L298 デュアル H ブリッジ | 1 | 4 輪駆動用(2 チャンネル ×2 または 4 チャンネル版) |
| サーボ MG996R | 2 | パン(水平) / チルト(垂直) |
| USB カメラ(ロジクール等) | 1 | 解像度 320×240 推奨 |
| HC-SR04 超音波距離センサー | 1 | 前方障害物検知用 |
| Dexter GoPiGo ベースキット(または同等シャーシ) | 1 | モーター・ホイール・フレーム込み |
| Li-Ion 1000 mAh + DC-DC コンバーター | 1式 | 5V/3.3V 供給用 |
ソフトウェアセットアップ(Ci20 / Linux)
# パッケージ更新
sudo apt-get update && sudo apt-get upgrade -y && sudo apt-get dist-upgrade -y
# OpenCV (Python バインディング込み)
sudo apt-get install libopencv-dev python-opencv
# PySerial
sudo apt-get install python python-serial
# シリアルポート権限 (Arduino が /dev/ttyUSB0 の場合)
sudo chown $USER:$USER /dev/ttyUSB0
# またはネイティブ UART 使用時
sudo chown $USER:$USER /dev/ttyS1
Python スクリプト:faceser.py(要点)
- Haar カスケードで顔検出(スケール 1.2、近傍 2、Canny プルーニング)
- 検出矩形の中心
(midFaceX, midFaceY)と画面中心(midScreenX, midScreenY)の差分でサーボ角度を ±1° ずつ更新 - デッドゾーン
midScreenWindow = 20ピクセル以内なら動作させない - サーボ指令プロトコル:
0xFF, servo_id(1/2), angle(0-180)の 3 バイトをシリアル送信 - 顔見失い時は徐々に初期位置(パン 90°, チルト 45°)へ復帰、20 秒経過でスキャンモードへ移行
Arduino スケッチ:Car.ino(要点)
- シリアル受信:先頭バイト 0xFF 確認後、サーボ ID と角度を取得
- サーボ 1(チルト)直接制御、サーボ 2(パン)は角度に応じて走行方向決定:
- 80-100°:前進/後退(超音波距離で判断)
- >100°:左旋回
- <80°:右旋回
- サーボ 3 指令でスキャンモード(チルト固定、パン往復)
- HC-SR04 距離測定関数
distancia()、前進/後退/左右/停止関数を実装
実行方法
# Haar カスケードファイルを同ディレクトリに配置
wget https://github.com/opencv/opencv/raw/master/data/haarcascades/haarcascade_frontalface_alt.xml
# 実行 (カメラインデックス 0)
sudo python faceser.py 0
映像表示を有効にするにはスクリプト内の cv.ShowImage 等のコメントアウトを外す。
既知の課題・改善点
- Haar カスケードは正面顔のみ検出、横顔・傾きに弱い → LBP カスケードや DNN (OpenCV DNN + Caffe/TensorFlow) への置換で改善可能
- サーボ制御がオープンループ(フィードバックなし) → ポテンショメータ内蔵サーボやエンコーダーでクローズドループ化
- 超音波センサーの更新レートが低い → TOF センサー (VL53L0X 等) への置換推奨
- Ci20 は生産終了 → Raspberry Pi 4 + USB カメラ、または Jetson Nano への移植が現実的
関連ファイル
faceser.py:顔検出・サーボ指令送信Car.ino:Arduino 側制御ロジックscanlinux.py:シリアルポート列挙ユーティリティ- 回路図:
schematic.png(ピンアサインは環境に合わせて調整)
製造プロセス
- Arduinoデジタルダイス: LCD表示の乱数ジェネレーター自作
- Arduino Nanoで37LEDルーレットゲームを自作:ヨーロピアンスタイル完全再現
- ATtiny85ミニアーケード:スネークゲーム - 手のひらサイズOLEDゲーム機の製作
- ポータブル距離検出器:Arduino Nano自作キット(HC-SR04、18650電源、3Dプリントケース付き)
- MobBob:Arduino製ロボットをAndroidスマホでシームレスに制御
- PiBot:Arduino駆動の精密ピアノ演奏ロボット
- 銅メッキプロジェクト:Arduino UNOで作るスマート電気メッキシステム
- Arduino Nanoで作るNeoPixelマトリックス版Pongゲーム
- 全方向移動ロボットで人物を安全追跡:オムニホイール搭載「ハンターフラッタラーボット」
- Arduinoシフトレジスタで美しい光のシーケンスを作成
- 顔認証で解錠するスマートドアアクセスシステム