ブロック崩し風ゲーム。未完成。続きを作ろう！

今回でこの講座は終わりです。先週作り始めたブロック崩し風ゲームを完成させましょう。

この手のゲームで必要になることは、ボールがブロックの当たったときにブロックの消す処理です。このサンプルプログラムではブロックを３個用意し、それぞれの当たりを判定する変数をblock1_hit, block2_hit, block3_hitとして０で初期化します。

ボールとブロックが衝突したらその変数を１に設定し、そのブロックを破壊し表示しないという処理を行っています。

// step6.cpp
int block1_hit = 0, block2_hit = 0, block3_hit = 0; //　ブロックにボールが衝突すれば１、しないと０

/***  シミュレーションループ　***/
void simLoop(int pause)
{
    int i, j;

    dmWorldQuickStep(); // シミュレーションを１ステップ進める(高速版)

    dmDraw(&ball);
    dmDraw(&bar);
    dmDraw(&field);

    for (i =0; i < 3; i++)
    {
        dmDraw(&fence[i]);
    }

    // ブロックがボールに衝突していない場合はブロックを表示し
    // ブロックがボールに衝突した場合はブロックを破壊する。
    if (block1_hit==0) dmDraw(&block1);
    else                  dmDestroyBox0(&block1);

    if (block2_hit==0) dmDraw(&block2);
    else                  dmDestroyBox0(&block2);

    if (block3_hit==0) dmDraw(&block3);
    else                  dmDestroyBox0(&block3);

    STEPS++;
}

次に、今まで秘密のベールに包まれていたdm6.cppを説明します。このファイルでODEを簡単に使う関数を作っています。まず、２，３行目のexternで始まる変数の宣言は、dm6.cpp以外のファイルで宣言しているよとコンパイラーに教えています。これらの行がないとblock1, block1_hitが宣言されていないとエラーになり、externを付けないとstep6.cppでも宣言されているので２重定義でエラーになってしまいます。大きなプログラムは複数のファイルで構成されるのでこのexternは覚えておきましょう。

お次は、衝突検出を説明します。これはdm6.cpp内のnearCallback関数で行われています。if else文でブロック１のジオメトリ(block1.geom)、ブロック２のジオメトリ(block2.geom)、ブロック３のジオメトリ(block3.geom)がボールのジオメトリ(ball.geom)がo1, o2のどちらかなら衝突しているので、衝突判定用の変数block1_hit, block2_hit, block3_hitに１を代入しています。なお、ジオメトリとはODEで衝突判定に使われる物体の属性です。

また、nearCallback関数は２つの物体（正確にはジオメトリ）が接近して衝突しそうになったら自動で呼び出せれる関数です。このような関数をコールバック関数と呼びます。電話のコールバックをイメージしてください。引数のジオメトリo1, o2は衝突しそうな２つのジオメトリです。

このサンプルプログラムでたった３個のブロック崩し風ゲームは完成です。後は、いろいろ工夫して自分だけのゲームを完成させてください。

終わり。

// dm6.cpp
extern dmObject ball, field, fence[3], bar, block1, block2, block3;
extern int block1_hit, block2_hit, block3_hit;

/*** 衝突検出関数（コールバック関数） ***/
void nearCallback(void *data, dGeomID o1, dGeomID o2)
{
    static const int N = 10; // 接触点数の最大値
    dContact contact[N];     // 接触点

    // 衝突情報の生成 nは衝突点数
    int n = dCollide(o1,o2,N,&contact[0].geom,sizeof(dContact));

    for (int i = 0; i < n; i++)
    {
        contact[i].surface.mode = dContactBounce; // 接触面の反発性を設定

        //　ボールとバーが接触したら反発係数を1.5に設定
        if(((ball.geom == o1) && (bar.geom == o2)) || ((ball.geom == o2) && (bar.geom == o1)))
        {
            contact[i].surface.bounce = 1.5;          // 反発係数(実際の世界では0.0から1.0)
        }
        // ボールと床が接触したら反発係数を0.5に設定
        else if (((ball.geom == o1) && (field.geom == o2)) || ((ball.geom == o2) && (field.geom == o1)))
        {
            contact[i].surface.bounce = 0.5;
        }
        // ボールとブロック１が接触したら。block1_hitを１に設定
        else if (((ball.geom == o1) && (block1.geom == o2)) || ((ball.geom == o2) && (block1.geom == o1)))
        {
             block1_hit = 1;
        }
        // ボールとブロック2が接触したら。block2_hitを１に設定
        else if (((ball.geom == o1) && (block2.geom == o2)) || ((ball.geom == o2) && (block2.geom == o1)))
        {
             block2_hit = 1;
        }
         // ボールとブロック3が接触したら。block2_hitを１に設定
        else if (((ball.geom == o1) && (block3.geom == o2)) || ((ball.geom == o2) && (block3.geom == o1)))
        {
             block3_hit = 1;
        }
        // その他は反発係数を0.8に設定
        else
        {
            contact[i].surface.bounce = 0.8;
        }

        // contact[i].surface.bounce_vel = 0.05;      // 反発に必要な最低速度
        contact[i].surface.mu = 0.0;// dInfinity;        // 摩擦係数

        // 接触ジョイントの生成
        dJointID c = dJointCreateContact(world,contactgroup,
                                         &contact[i]);
        // 接触している２つの剛体を接触ジョイントにより拘束
        dJointAttach(c,dGeomGetBody(contact[i].geom.g1),
                     dGeomGetBody(contact[i].geom.g2));
    }
}

ホームワーク

1. step6-120119.zipをダウンロードして実行しよう！
2. ブロックの数を１個増やそう。
3. ３で作ったブロックの色を黒に変更しよう。
4. ブロックの数を増やし、競技盤の半分ぐらいは埋め尽くそう。配列を使うのが望ましい。
5. ボールの初期位置と飛び出す方向をランダムに変えよう。
6. バーが競技盤を飛び出してしまいます。飛び出さないようにしよう。
7. 得点を表示する機能を付けよう。標準出力にprintfでもかまいません。
8. いろいろ工夫して自分だけのブロック崩し風ゲームを作ろう！遊ぶためにゲームの説明を文字ウインドウに表示しよう。

ブロック崩しを作ろう！

少し、遅くなりましたが新年明けましておめでとうございます。今年も、demura.netをよろしくお願いします。

ODEで学ぶC言語2のStep5です．今回は構造体と物体へ力やトルクを加える方法，さらにシミュレーションのリセット法などを学びます．構造体の概要については既にわかっているものとし，サンプルコードを示すことにより具体的な使い方を学びます．例として、Step5とStep6でスティーブン・ジョブスがAtari社時代に、アップルの共同設立者ウォズニアックと開発に携わったBreakout（ブロック崩し）風のゲームを作ってみましょう。

○　構造体

配列では同じ型しかまとめることができませんでしたが，構造体では違う型をまとめて扱うことができるのでシミュレーションなど物体に多くの属性がある場合に便利です．このサンプルプログラムでは物体をdmObjectという構造体で次のように表しています．dm5.hの１６行目に定義しています．

typedef struct{
    dBodyID body; // ボディのID
    dGeomID geom; // ジオメトリのID
    const double *p; // x, y, z　[m]
    const double *R;   // 回転行列 要素数4x3
    double m; // 質量 [kg]
    double r,l; // 半径 [m], 長さ [m]
    const double *side; // サイズ　x,y,z
    const double *color; // 色 r,g,b
} dmObject;

また、STEP4まではdmLoop関数の引数にstep関数やcommand関数を渡していましたが、ここでは関数のポインタを要素に持つ構造体dmFunctionsを定義します。今まではdmLoopに渡す関数が増えるとその数だけ引数が多くなってしまいましたが、この構造体だけを引数として渡せば良いのでプログラムがすっきりします。

typedef struct
{
    void (*start)();            // 初期化関数
    void (*step) (int pause);	// ステップ関数
    void (*command) (int cmd);	// キー関数
} dmFunctions;

○ 衝突検出だけ働く物体の作り方

物理エンジンODEでは物体は２つの属性からできています。一つは動力学計算の対象となるbody（ボディ）、もう一つは衝突検出の対象となるgeometry（ジオメトリ）です。ゲームでは動かない建物や壁など動力学計算を働かせる必要のない物体は衝突検出計算だけを適応すれば計算処理が軽くて済みます。ここでは、衝突検出計算だけ働く物体を作るAPIを紹介します。

• void dmCreateBox0(dmObject *obj, double p[3], double R[12], double m, double side[3], double color[3]);

衝突検出計算しか作用しない物体を作成します．dmCreateBoxの後に0（零）を付け加えたAPI名です。引数のp[3]は位置(x,y,z)[m]，R[12]は姿勢（回転行列）, mは質量[kg]，sideは直方体の各辺の長さ[m]，color[3]は色(赤，緑，青各成分、値は0以上1以下）です．同様なAPIとして、dmCreateSphere0, dmCreateCylinder0, dmCreateCapsule0があります。

○ 姿勢の変更

物体の姿勢を変更するためには次のAPIを使い回転行列Rの値を変更します．ここで，Rは回転行列が格納されている配列へのポインタ，ax, ay, axは回転軸ベクトル．angleは回転角度となります．なお，dだけで始まるAPIはODEのAPIです．

• dRFromAxisAndAngle(double　R[12], double  ax, doulbe  ay, double  az, double angle);

○　力，トルクの加え方

• void dmAddForce(dmObject *obj, double fx, double fy, double fz)
  • 物体objの重心に力(fx,fy,fz)を加える
• void dmAddTorque(dmObject *obj, double fx, double fy, double fz)
  • 物体objの重心にトルク(fx, fy, fz)を加える．fx，ｆｙ，ｆｚはそれぞれx, y, z軸まわりのトルク

○　高速なシミュレーション

前回のサンプルではシミュレーションのステップ関数としてdmWorldStep()を使いましたが，ここではより高速なdmWorldQuickStep()を使います．ただし，dmWorldStep()と比較して精度が悪くなります．

○　シミュレーションのリセット

rまたはRキーを押すと，resetSim関数が呼ばれてシミュレーションがリセットされます．resetSimの中身はシミュレーションループが１回以上呼び出されたときにdmInit関数を呼び出して初期化し，物体を再度生成しています．

○　ソースコード

/* step5 ブロック崩し 2012-01-09 　*/
#include "dm5.h"

static int STEPS = 0;   // シミュレーションのステップ数
double red[3]     = {1.3, 0.0, 0.0}; // 赤色
double yellow[3] = {1.3, 1.3, 0.0}; // 黄色
double green[3] = {0.0, 0.8, 0.0}; // 緑色

dmObject ball, field, fence[3], bar; // ドミノ, フィールド, 柵
dmFunctions dmf; // 描画関数の構造体

/***  シミュレーションループ　***/
void simLoop(int pause)
{
    int i;

    dmWorldQuickStep(); // シミュレーションを１ステップ進める(高速版)

    dmDraw(&ball);
    dmDraw(&bar);
    dmDraw(&field);
    for (i =0; i < 3; i++)
    {
        dmDraw(&fence[i]);
    }

    STEPS++;
}

void resetSim(int n)
{
    double m = 0.1; // 質量
    double side[3] = {0.2, 0.05, 0.5}; // サイズ
    double R[12] = {1,0,0,0, 0,1,0,0, 0,0,1,0}; // 姿勢
    double ball_pos[3]={-0.91, 0.25, 0.7}, ball_r = 0.03, ball_m = 0.1; // ボールの位置、半径、質量
    double bar_pos[3]={-0.08, 0, 0.6}, bar_side[3] = {0.01, 0.1, 0.1}, bar_m = 0.1; // ボールの位置、半径、質量
    double field_pos[3]={-0.5, 0, 0.5}, field_side[3] = {1, 1, 0.01}, field_m; // フィールドの位置、サイズ, 質量
    double fence_pos[3][3] = {{-1.0, 0, 0.6}, {-0.5, -0.5, 0.6},{-0.5, 0.5, 0.6}};　// 柵の位置
    double fence_side[3][3] = {{0.05, 1.05, 0.1}, {1.0, 0.05, 0.1}, {1.0, 0.05, 0.1}};
    double fence_m[3] = {0.1, 0.1, 0.1};
    int i;

    // シミュレーションの終了
    if (STEPS != 0)
    {
        dmClose();
    }

    dmInit(); // 初期化

    //  ボールの生成
    dmCreateSphere(&ball, ball_pos, R, ball_m, ball_r, red);

    // バーの生成
    dmCreateBox0(&bar, bar_pos, R, bar_m, bar_side, yellow);

    // フィールドの生成
    dmCreateBox0(&field, field_pos, R, field_m, field_side, green);
    for (i =0; i < 3; i++) {
        dmCreateBox0(&fence[i], fence_pos[i], R, fence_m[i], fence_side[i], green);
    }
}

/*** キ―入力関数 ***/
void command(int cmd)
{
    switch (cmd)
    {
    case 'r':
    case 'R':
        resetSim(0);
        break;
     default:
        printf("Input r, R, f, F key \n");
        break;
    }
}

/*** カメラの位置と姿勢設定 ***/
void setCamera()
{
    float x =  -0.5, y = 0.0, z = 1.5;    // カメラの位置
    float roll = 0, pitch = -90, yaw = -180; // カメラの方向[°]
    dmSetCamera(x,y,z,roll,pitch,yaw);  // カメラの設定
}

/*** 描画用構造体の設定　***/
void setDraw()
{
    dmf.start       = &setCamera;
    dmf.step        = &simLoop;
    dmf.command = &command;
}

/*** main関数 ***/
int main()
{
    resetSim(0); // シミュレーションのリセット
    setDraw();   // 描画関数の設定
    dmLoop(800, 600, &dmf);  // ウインドウの幅，高, ループ関数，コマンド関数
    dmClose(); // 終了
    return 0;
}

ホームワーク５

1. これをダウンロードstep5a-120110して実行しよう！
2. 黄色のバーをfまたはFキーを押すと左、jまたはJキーを押すと右にバーが動くように変更しよう！
   ヒント：　黄色のバーには動力学を適応させていないのでdGeomSetPosition(dGeomID geom, double x, double y, double z);を使って強制的に位置を移動させる。ここで、１番目の引数にはbar.geomを入れればよい。2から４番目の引数は、絶対座標系での位置のx, y, z成分。
3. ボールが斜めに落ちるように、初めに横方向に力を加えよう！
   ヒント：dmAddForce(dmObject *obj, double fx, double fy, double fz); を使おう。resetSim関数内のdmCreateSphere関数のすぐ後にdmAddForceを入れよう。なお、力の方向や大きさを乱数を使って変化させるとゲームが面白くなる。
4. ブロックを３行１０列、合計３０個表示しよう！各行で色を変えると見栄えがするよ。
   ヒント： dmObject fence[3]; ボール落下防止用の柵に関するコードを参考にすると良い。

落下する赤い球

ODEで学ぶC言語のStep4です．今回は私がODEのAPIを元に作成した関数を使い，赤い球を落下させるプログラムを説明します．

step3サンプルプログラムの実行画面

Step2でfor文を使った繰り返しを練習しました。ここではswitch文を使ったキー処理の方法を学びます．キーボード入力の処理にswitch文はうってつけです。 ゲームではキーボード入力によりレーザービームを発射したり，車を操縦しますね．switch文を使って，キーボードからのキー入力を処理する方法を学びます．

• switch文とキー処理

新しく登場したのが11行目のcommand関数です．これは，キーボードからのキー入力を引数cmdとして受け取ります．このサンプルプログラムではswitch文を使いキー入力の値に応じて分岐させ違う処理をさせています．zが入力されると初期位置のz成分を0.1m増加させます．つまり，zキーを押すたびに直方体全体が上空へ上がっていきます．その下のbreak文は忘れないでください．忘れるとdefaultに対応する21行目の文を実行し常にInput z keyと表示されてしまいます．

その他のキーを入力するとdefaultにある”Input z key”という文字列がコンソール画面に表示されます． なお、switch文の変わりにif文でもできますが、キー入力が増え分岐が多くなるとswitch文の方がすっきりした読みやすいプログラムを書けます。

• 乱　数

ODEとは関係ありませんがゲームやシミュレータでは乱数も活躍します．乱数を使う場合は”stdlib.h”をインクルードします．ここではtime()関数も使っているので”time.h”もインクルードしています．

乱数を使用する場合は、まず，main関数の42行目にあるように乱数を初期化します．そのためにvoid srand(unsigned seed）関数を使います。引数seedは乱数を発生させる種を入れます．それが同じ値の場合は，常に同じ乱数系列が発生します．srand(time(NULL))は実行時に乱数の種を変更する一般的な方法です． ちなみに、time(NULL)は万国標準時１９７０年１月１日からの経過秒数です。大きな数値になるのでパット見意味がわからりづらいですね．

実際に乱数を発生させているのがsimLoop関数の30行目のrand関数です．rand関数のプロトタイプ宣言はint rand(void)なので引数は取らず，int型の値を返します．RAND_MAXは乱数の最大値なので，30行目は0以上1以下の乱数を発生させ，それを赤成分の値に代入します．なお，rand()とRAND_MAXの割り算をするとint型になり小数点以下が切り捨てられるのでfloat型にキャスト（型変換）することを忘れないようにしましょう．これによって，表示されている直方体（以下ボックスと表記）の赤成分の色だけが変わることになります．

今回は２つのことを学びました．特に乱数はゲームで使うと非常に面白いゲームになるのでしっかり覚えておきましょう．

でむ

/* step3 キー入力　switch文　*/
#include "dm3.h"
#include <time.h>
#include <stdlib.h>

// Rは回転行列の各要素が格納される配列. 4, 8, 12番目の要素は高速化のために常に０
double R[12] ={1,0,0,0, 0,1,0,0, 0,0,1,0};
double p[3] = {0.0, 0.0, 0.05};   //　重心の位置
double p[3] = {0.0, 0.0, 0.05};   // 位置(x,y,z)[m]
double sides[3] = {0.1, 0.1, 0.1}; // 直方体のサイズ(x, y, z)[m]
double start_x = 0.0, start_y = 0.0, start_z = 0.0; // 初期位置

void command(int cmd)
{
    float xyz[3], hpr[3];
    switch (cmd) {
        case 'z':
            start_z += 0.1;
            break;
        default:
            printf("Input z key \n");
    }
}

void simLoop(int pause)        /***  シミュレーションループ　***/
{
  int i, j, num = 11;          // 直方体の数
  static float red = 0.0, green = 0.0, blue = 0.0; // 赤，緑，青成分

  for (i = 0; i < num; i++) {
      for (j = 0; j < num; j++) {
        red = (float) rand()/RAND_MAX;   // 赤成分を乱数で決定
        dsSetColor(red, green, blue);    // 色の設定
        p[0] = start_x;                  // 位置のx成分
        p[1] = i * 0.2 - 1.0  + start_y; // 位置のy成分
        p[2] = j * 0.2 + 0.05 + start_z; // 位置のz成分
        dsDrawBox(p,R,sides); // 直方体の表示
      }
  }
}

int main()         /*** main関数 ***/
{
  srand(time(NULL)); // 乱数の初期化
  dmLoop(800, 600, simLoop, command);  // ウインドウの横，縦，シミュレーション関数，コマンド関数
　return 0;
}

ホームワーク３

1. step3-101217.zipをダウンロードして実行しよう．
2. jキーを押すと右，fキーを押すと左にボックス全体が移動するようにしよう．
3. ３行（ｊの値が２）、４列（iの値が３）目のボックスだけをキー操作でx, y, z軸の正負方向へ移動できるようにしよう．つまり，６個のキーを割り当てる必要があります．simLoop関数の中でif文を使う必要があります．
4. まず、ボックスを全て白色に変更し，乱数を使い１つのボックスだけ赤色に描画するプログラムを書こう．
5. まず、ボックスを全て白にし、数字０を赤いブロックを複数使い電光掲示板のように表示するプログラムを書こう．
6. [発展問題」　まず、ボックスを全て白にし、９から０までの数字を赤いブロックを複数使いカウントダウン表示する電光掲示板を作りましょう。０から９までの数字を表示する部分はそれぞれ関数にすること。

ピラミッド：ホームワーク６の答え

Step1で物体の描画を学びました．今回は同じ形状のものを繰り返しても描画する方法を学びます．

C言語の繰り返しにはfor文, while文，do while文がありましたね．ここではfor文を使い，上図のようなピラミッドを作ってみましょう．では、さっそくソースコードを見ていきます．

4行目から6行目は配列の初期化です．宣言と同時に値を代入することを初期化とよびます．
13行目のdsSetColor()は色を設定する関数です．引数は光の3原色の値を3個取り，１番目は赤，２番目は緑，３番目は青成分で0以上1以下の値となります．ちなみに，全部0だと黒，全部1.0だと白です．
15から18行目がfor文です．繰り返し回数はnum回，ここでは10行目でnumが11になっているので，11回ループが回ることになります．
16行目のp[1]は絶対座標系のy座標の値です．なお，p[0]にはx座標，p[2]にはz座標の値が入っていて，x座標は地面の中央マーカーから赤マーカーの方向，y座標は中央マーカーから青マーカーの方向，z座標は中央マーカーから上空方向になります．
17行目は直方体の描画です．
これで今回は終わりです．ホームワークは少し難しくします.

/* step2 物体の繰り返し表示　*/
#include "dm2.h"
 // Rは回転行列の各要素が格納される配列. 4, 8, 12番目の要素は高速化のために常に０
double R[12] ={1,0,0,0, 0,1,0,0, 0,0,1,0};
double p[3] = {0.0, 0.0, 0.05};   //　重心の位置(x,y,z)[m]
double sides[3] = {0.1, 0.1, 0.1}; // 直方体の各辺の長さ(x, y, z)[m]

void simLoop(int pause)        /***  シミュレーションループ　***/
{
　int i, num = 11;             // 直方体の数
　dsSetColor(1.0, 0.0, 0.0);   // 赤色の設定(赤，緑，青）
　for (i = 0; i < num; i++) {
　　p[1] = i * 0.2;       // p[1]は直方体重心のy軸成分
　　dsDrawBox(p,R,sides); // 直方体の表示
　}
}

int main()         /*** main関数 ***/
{
　dmLoop(800, 600, simLoop); // シミュレーションループ ウインドウの幅，高，ループ関数
　return 0;
}

ホームワーク２

1. step2-101208.zipをダウンロードして実行しよう．
2. 赤い直方体（この例では立方体）の色を黄に変えよう．
   • dsSetColor(float r, float g, float b)
     r, g, bは光の３原色の赤、緑、青成分。値は0以上１以下。例えば、緑にしたかったらrとbは０、gには１を代入する。
3. 赤い直方体の位置を左にずらし，中央の直方体が原点に来るようにしましょう．
4. 上の問題で，直方体の色を白から赤に徐々に変化させよう．
5. forループを２重にし，ｘ軸方向にも直方体を描画し，合計121個の直方体を表示しよう．
6. forループを３重にし、z軸方向（上空方向）にも直方体を10段（合計11段）描画し、大きな立方体を表示しよう。
7. forループを３重にし，z軸方向にも直方体を描画し，直方体の間隔も調整して上図のようなピラミッドを作ろう．

昔エジプトに行きピラミッドに少しだけ登ったことがあります。遠くからはきれいな四角錐に見えますが、大きな立方体が積み重ねられできています。残念ながら今は登ることが禁止されているようですね。昨年ABUロボコンのエジプト大会に出場した学生に聞くと、天辺まで上らないように銃を構えた兵士が睨みを利かせているそうです。もっともこれは、以前テロが起き観光客に犠牲者が出たためでしょう。

でむ

step1.cppの実行画面

物理エンジンを使い楽しみながらＣ言語をマスターすることを目指して連載します。

なお，C言語の基本的なことは知っていることを前提としますので，プログラミング能力を高めるための楽しい演習だと思ってください．

今回は何もなかった仮想空間に物体を表示させてみましょう．ODEではいろいろな形状がサポートされています．ここではその中でも使い方が最も簡単な球を表示させます．

/* step1 球の表示　*/
#include "dm1.h"

double R[12];                  // 回転行列(姿勢)の値を入れる配列
double p[3] = {0.0, 0.0, 1.0}; // 位置(x,y,z)[m]
double r = 0.2;                // 半径 [m]

void simLoop(int pause)        /***  シミュレーションループ　***/
{
  dsDrawSphere(p,R,r);         // 球の描画
}

int main()         /*** main関数 ***/
{
  dmLoop(800, 600, simLoop); // シミュレーションループ（ウインドウの横，縦）
  return 0;
}

まず，２行目のdm1.hはＯＤＥをより簡単に使うためのヘッダーファイルです．Step1ではまだ説明しません．

一般的に物体を３次元空間上に表示させるためには，物体の位置と姿勢を決める必要があります．ODEでは姿勢を回転行列とよばれる行列で表しています．その行列の要素を格納するのが配列R[12]です．回転行列は３×３の行列なので，１次元配列では要素数が９個で十分ですが，ODEでは高速化のために要素数12個の配列を用意します．配列の4, 8, 12番目の様子は０になっています．なお，R[12]には謎のヘッダファイルdm1.hの中で単位行列が設定されています．

また，位置は要素数３個のdouble型の配列p[3]に格納しています．位置のx座標(手前方向）を表す変数pの1番目の要素p[0]には0.0[m]，y座標（右方向）, z座標（高さ方向）を表すp[1], p[2]には0.0[m],　1.0[m]が設定されています．座標系は右手系です。上の図では中心から赤いピラミッドの方向がｘ軸の正，青いピラミッドの方向がｙ軸の正，上空方向がz軸の正です．ODEでは単位系はSI単位系で，長さはm，質量はkg，力はNとなります．

ソースコードのなかほどにあるsimLoop関数にシミュレーションでやりたいことを書きます．ここでは，球を表示したいのでdsDrawSphere関数を使って，位置p，姿勢R, 半径rの球を描画しています．なお、このソースコードだけではわかりませんが、simLoop関数はdmLoop関数の中で毎回呼び出されています。

今回はこれで終わりです．簡単でしたね．なお，この説明でわからない場合は，わからない部分をコメントに書いて頂けると補足説明します．

• ホームワーク１
  1. step1-111202.zipをダウンロードし，実行してください．
  2. 手順
     • ode-0.11.1がインストールされていなかったらこの説明に従いインストールする．
     • ダウンロードしたファイルをc:\ode-0.11.1\myprogの中に保存する．
     • そこで解凍する．c:\ode-0.11.1\myprog\step1というフォルダが作られます．
     • c:\ode-0.11.1\myprog\step1\step1.cbpをダブルクリックしてcodeblocksを起動しビルド・実行する．ダブルクリックするファイルの拡張子はcbpです．間違ってcppをダブルクリックしないように！
  3. 球の位置と大きさを変更してみましょう．
     • プロトタイプ宣言
       • void dsDrawSphere(const double　p[3], const double R[12],  double r)
     • 引数p[3]は位置，R[12]は姿勢，rは半径.
  4. 直方体を表示させてください．次の関数を使います．
     • プロトタイプ宣言
       • void dsDrawBox(const double　p[3], const double R[12], const double sides[3])
     • 上は関数のプロトタイプ宣言の形式なので，呼び出すときはconst doubleなどの型名を入れてはいけません．引数が配列の場合は，サンプルプログラムのように配列名だけを入れてください．
       例　dsDrawBox(p, R, sides);  // 呼び出す場合は配列名だけ
     • 1, 2番目の引数はdsDrawSphereのときと同じです．3番目の引数は直方体のx,y,z方向のサイズ[m]が入っている要素数3個の配列です．位置を表す配列pと同じように初期化すれば大丈夫です．
     • なお, doubleの前にあるconstは値を変えてはいけないという意味です。円柱を表示させてください
  5. 円柱を表示させましょう．
     • プロトタイプ宣言
       • void dsDrawCylinder(const double　p[3], const double R[12],  double l, double r );
     • ここで，lは長さ，rは半径です．
  6. カプセルを表示させてください．
     • プロトタイプ宣言
       • void dsDrawCapsule(const double  p[3], const double R[12], double l,  float r );

以上

JR尼崎はJR大阪駅から６分なので、金沢からはとても行きやすいところです。宿泊施設も近くにあり心配はないとのこと。尼崎市はとても力をいれているそうなので、きっと素晴らしい大会になると思います。

ロボカップジュニアジャパンオープン２０１１予定

つくばチャレンジ2011に出場した金沢工業大学出村研究室のトライアル走行ビデオ。つくばチャレンジ最後の年に、満を持して登場したが結果は．．．　けんせいちゃん４号機は着実に進化し、昨年は音声発話とロボットアームが搭載され、今年は音声認識の機能が追加された。地道に技術力をアップし、いつの日かリベンジを狙おう。

つくばチャレンジ2011：demura.netチーム

つくばチャレンジ２０１１本番。１１月１５日はトライアル。demura.netチームは１回目7m、２回目102mという結果に終わった。過去２年トライアルは通過していただけにとても残念。

ある会社に特注したロボットに不具合が多発し、最終的な納品が５カ月遅れ８月３１日になった。そこから２か月半で全てのソフトウェアシステムを作りあげ。つくば市に到着した３日前はロボットが前に進まない状態。それから、何とか102ｍまで進むことができたことは学生達の努力の賜物。ごくろうさま。

demura.netチームのつくばチャレンジは終わったが、このロボットは高齢者や障害者支援用の自律車いすなので、そのような方のお役に立てる研究をしていきたい。

ロシアのクラスノヤルスクで頂いたベストを背景に明日のつくばチャレンジの準備に励むメンバー

ロシアのクラスノヤルスクで頂いたベストをきてベストを尽くそう。明日のつくばチャレンジでは誰かに着てもらおう。