ロボットのGUIコントローラを作る（その５）

初稿: 2013/10/4, 最終更新:

５．マウスで関節を動かせるようにする

マウスでロボットの関節を操作できたら格好いいのですが、どうすればできるのでしょうか？なんと便利なことにopenFrameworksのexampleの中にpointPickerExampleがあり、参考にできます。場所は、C:\workspace\of_v0.8.0_vs_release\examples\3d\pointPickerExample

ですので、興味があれば試してみてください。

５．１　ロボットの関節を摘まむ

サンプルプログラムでは、スクリーン座標系で、マウスカーソルの位置と、世界座標系からスクリーン座標系へ変換されたメッシュの頂点位置との距離を調べることで、最近傍の頂点を選択していました。これを参考に、首や腰の関節をマウスで動かすルーチンを書いてみましょう。マウスの中ボタンを押したときに一番近い関節を操作するように設計します。

まず、マウスの中ボタンが押されたときのスクリーン座標系におけるマウス座標を調べます。マウスのボタンが押されると、mousePressed(int x, int y, int button)という関数が呼ばれます。引数にあるx,yがマウスカーソルの座標を表し、buttonがどのボタンを押したかを表します。

次に、スクリーン座標系でのロボットの関節の座標を次のように求めます。

ofMatrix4x4m=model.getMeshHelper(i).matrix*model.getModelMatrix();

ofVec3f cur = cam.worldToScreen(m.getTranslation());

スクリーン座標系での２点の座標が求まりましたから、距離を計算するのはsqrt((x1-x0)^2+(y1-y0)^2)なので簡単ですね。ここでは更に便利な関数distanceで直接求めています。すべてのノードの座標を調べて距離が最短のものを保存します。また、関節から２０ピクセル以上離れたところでボタンが押されても感知しないようにします。その場合、-1が何も選択されていないことを表すというローカルルールを作って、nearestIndexに与えることにします。

f:id:cvl-robot:20131005000507j:plain fig.9 首を摘まんだ結果

Index 7という答えが得られました。ところで7って何でしょうか。少し謎を残したまま先に進みます。

５．２　マウスのドラッグで関節角度を調整する

nearestIndexの値を他の関数からも見られるように、testApp.hで宣言するように変更します。また、関節の角度をパラメータで持てるようにchest, pan, tiltの３つの変数を導入しておきます。

int nearestIndex;

float chest, pan, tilt;

マウスのボタンを押しながら移動させることをドラッグと言います。そのような操作をしたときにopenFrameworksではmouseDragged(int x, int y, int button)という関数が呼ばれます。マウスの位置と画面の幅と高さの比から適当に回転量を決めるようにしてみましょう。画面の端から端まで移動したら３６０度動くことにします。

首を押したらIndex番号が７と表示されましたが、これはofxAssimpMeshHelperがメッシュを順番に番号付けしている数字です。ちょっと扱いづらいので、メッシュではなくノードを、ノードの名前で呼び出せるようにしたいところですが、ちょっと置いておきます。mesh番号を表示したり消したり、クリックしたりいろいろ調べていくと、０－３が左指、６が腰、７，８が首、９－１４が右腕、１５－２０が左腕であることがわかりました。そこでnearestIndexが腰6、首７,８のときに角度の変更が反映されるようにします。

また、ドラッグの最中にカメラが動いてしまうと操作しづらいので、ofEasyCamのマウス操作を無効にしておきます。マウスのボタンを離したときに再び有効になるようにしています。

void testApp::update()関数の中で、chest, pan, tiltのパラメータで関節角度が更新されるようにします。

f:id:cvl-robot:20131006025844j:plain fig.10 ドラッグで関節角度調整