More than 5 years have passed since last update.

Raspberry Pi サーボモーターとOpen CVで物体追跡カメラ（Meanshift）

Last updated at 2017-03-15Posted at 2017-03-14

物体追跡カメラをRaspberryPiで作ってみました。Python3系で動きます。指定した枠内に最初に映ったものを追尾します。「青りんご」で試してみます。

こんな感じです。ちょっと小動物みたいで可愛いですね。

環境

RaspberryPiのGPIOから直接サーボモーターを制御すると、電圧の変化でショートしてしまうようです。今回はモータドライバーを使い、単４電池３本から本体とは別に電源を取り込んでいます。

Python3系で制御できるので、OpenCVから取り込んだデータをそのまま利用することが出来ました。モーターの制御とOpenCVからデータを取得するのと大きく２つに分けて解説してみたいと思います。

以下のモーターシールドを利用してサーボモーターを制御します。半田付けがしてあるので初心者にも安心です。

Adafruit 16-Channel Servo Driverという比較的ポピュラーなモータードライバの互換機なので、Adafruit社の用意してくれているPythonライブラリがそのまま利用できます。

結構この手のライブラリは２系で書かれたものが多いのですが、3系で動作しましたので助かりました。

上記の２ファイルで下記の様に動作します。

端子の接続は下記写真を参考にして下さい。

webカメラは既存の台座から外し、ネジでカメラマウントに固定しました。

今回は物体検出をするのにOpenCVのMeanshiftというアルゴリズムを利用しました。

最初に指定したウインドウの色ヒストグラムを元に、同じ重みを持つ点をスライドしながら検索していくアルゴリズムです。

こちらの動画を見るとなんとなくイメージが湧きました。

サンプルコードを試して見ると、うまく動作したので、物体追跡した中心点に向かってカメラを移動させてみました。

サーボモーターの角度は、ニュートラルの角度がx軸475、y軸325。最小角度が150、最大角度が600です。物体の中心点が画面の中心点から離れた距離をOpenCVで算出して、それを元にサーボモーターの角度を変更する様にしてみました。

カメラマウントをもう少しダイナミックに動かしてみたかったんですが、移動角度が大きくなるとカメラ上の物体認識が大きくぶれてしまいカメラがガクンガクンと大きくぶれてしまいます。

OpenCVの画像を小さめにすることで（320x320ピクセル）今回は対応してみました。

超音波センサーなどのアナログセンサーを使った方が実用的なのかもしれませんね。

ともあれ以前より試してみたかった物がやっと作れたので良しとします。では。