2009/12/03

Hibikino-Musashiのプログラム(3)

こんにちは。

今回は「画像処理」についてお話しします。

ロボットの頭には全方位カメラが取り付けられています。


カメラはSONY製のDFW-VL500です。

また、カメラの性能を最大限に引き出すため、ドライバはCMU 1394 Digital Camera Driverを使っています。

画像処理にはOpenCVというライブラリを使っています。

画像処理は「画像取得スレッド」と「画像処理スレッド」に分かれています。

最近流行のマルチスレッドで動いているんですね~。

画像取得スレッドでは、
 ・データの読み出し
 ・240×240にトリミング
 ・色変換(YUVとHSV)& 色抽出

画像処理スレッドでは、
 ・ボール検出
 ・自己位置推定
 ・障害物検出

といった処理を行っています。

中型リーグでは自己位置推定が大きな課題となっており、多くのチームが「パーティクルフィルタ」を用いた手法を採用しています。

OpenCVではパーティクルフィルタは「Condensation」という形で実装されています。パーティクルフィルタって何?という方はこちらをどうぞ(英語サイトです)。

検出した白線情報を元に、パーティクルフィルタによって自己位置を求めます。

↓こんな感じ


画像処理は行動に比べて専門性が高いです。

ですが、わかるようになれば、これほど面白いものはありません。「あれをやってみよう!」「こういうのはどうか?」など、考えを巡らせるのが楽しくなっていきます。

次回は「通信」についてお送りします。

2009/12/02

Hibikino-Musashiのプログラム(2)

こんにちは。

今回は行動プログラムについてお話しします。

ロボットの「行動」とは、ボールを取りに行ったり、シュートしたりすることを指します。

Hibikino-Musashiのプログラムでは、
 1.行動選択
 2.行動実行
 3.下位制御
といった流れでロボットを動かしています。

1.行動選択では、「キックオフ」の信号が来たら何をする や、フォワードやディフェンダーといったロール(役割)を決める といった処理を行います。

2.行動実行では、具体的にどういう動きをすればよいかを計算して、目標速度や進行方向などを算出します。

3.下位制御では、モーターを回したり、方位センサやエンコーダからのデータを読み出します。

行動プログラムで重要なのが、「ボールを取る動作」と「ボールを運ぶ動作」です。これらに関しては、ポテンシャル関数を使って軌道生成をしたり、他チームの論文を参考にしてファジー制御を取り入れたりしています。

ちなみに、前回の動画ではポテンシャル法で動きを作っています。

ボールの相対距離・角度と、ゴールの相対角度を用いて、


↓このような式を作ります(aは正の定数、Vminはロボットの最低速度)。

Omegaが角速度、Angleが進行方向、Velocityが速度ですので、ロボットはゴールの方向を向きつつボールとゴールが一直線に並ぶような位置に緩やかに減速しながら移動します。

いかがでしたでしょうか?

行動プログラムでは、この他にも回転行列を使ったロボットのポジショニングなど、面白いコードを見ることが出来ます。

基本的に使われているのは高校レベルの数学ですので、そこまで難しくはありませんよ。

次回は「画像処理」についてお送りします。

2009/12/01

Hibikino-Musashiのプログラム(1)

みなさん、こんにちは。

先月の「ひびきの祭」デモは大盛況のうちに終了しました。

ご来場いただいた皆さま、本当にありがとうございました。

さて、当ブログでは、これまでHibikino-Musashiのロボットの活躍やデモの様子などをお送りしてきましたが、

「ロボットって どうやって動いているの?」
「プログラムってなに?」

と、興味を持ってくださった方もきっと多いことと思います。

そこで今回はロボットのプログラムについてご紹介します。

まずはこちらの動画をご覧下さい。



ロボットの中心にはノートPCが入っています。

私たちは、このノートPCにプログラムを入れてロボットを動かしています。

プログラムは大体10,000行ぐらいですね。言語はC++です。

内容は大きく分けると、
 ・行動
 ・画像処理
 ・通信
 ・シミュレータ
の4つです。ソフト班メンバーが分担して作っています。

今日から1週間にわたって、Hibikino-Musashiのプログラムを紹介していきます。

次回は「行動」プログラムについてお送りします。