2009/02/09

距離校正はつらいよ(4)

こんばんは、ソフト班Shinpukuです。

今日は指数近似を用いた距離校正プログラムの実験です。

でも、その前に・・・

ロボットのカメラが少し傾いていたので、機械班の人に直してもらいました。


さて、距離校正の実験です。


前回と同じく16サンプル採って、理論値と比較してみました。

図中のピンクが距離校正用サンプルで、これを元に近似式を作っています。

その上で、2回目の計測を行ったのが青の点です。

1.0m~3.5mはうまく出ています。

近距離と遠距離がイマイチです。

近距離の精度が悪いのは計測方法が間違っていたのでしょうか?

まぁ、これは何とかなるでしょう。

問題は遠距離です。

誤差0.8mって何ですか?

ていうか遠距離はムリですよ。

解像度240×240ですよ。

ムチャ言わないで下さいよ。

2009/02/08

距離校正はつらいよ(3)

こんにちは、ソフト班Shinpukuです。

指数近似のプログラム書きましたよ。

#include <stdio.h>
#include <math.h>

#define DATA_NUM 17

int main(void)
{
    //距離
    double distance[DATA_NUM] = {0.3, 0.4, 0.5, 0.6, 0.7, 0.8, 0.9, 1.0, 1.5,
                                                                    2.0, 2.5, 3.0, 3.5, 4.0, 4.5, 5.0, 5.5};

    // 中心からのピクセル数
    double pixels[DATA_NUM] = {21, 27, 31, 37, 42, 44, 46, 50, 62, 68, 74,
                                                               76, 80, 82, 84, 84, 86};

    double X[DATA_NUM], Y[DATA_NUM];
    double sumX, sumX2;
    double sumY, sumXY;

    // XとY初期化
    for (int i = 0; i < DATA_NUM; i++) {
        X[i] = pixels[i];
        Y[i] = log(distance[i]);
        
    }

    // Σたち
    sumX = sumX2 = sumY = sumXY = 0;
    for (int i = 0; i < DATA_NUM; i++) {
        sumX += X[i];
        sumX2 += X[i]*X[i];
        sumY += Y[i];
        sumXY += X[i]*Y[i];
    }

    // 最小2乗計算
    double A1 = (sumX*sumY - DATA_NUM*sumXY)/
                                (sumX*sumX - DATA_NUM*sumX2);

    double A0 = (-sumX2*sumY + sumX*sumXY)/
                                (sumX*sumX - DATA_NUM*sumX2);

    double alpha = exp(A0);
    double beta = A1;

    printf("alpha = %f\n", alpha);
    printf("beta = %f\n", beta);

    return 0;
}

α=0.122702
β=0.042482
と出て、

x=中心からのピクセル数
y = α * exp(β * x)
で距離yが出ます。

2009/02/07

距離校正はつらいよ(2)

こんにちは、ソフト班Shinpukuです。

距離校正の話の続きです。

具体的にどうやって距離を算出するかといいますと、ボール等を用いて、「中心から○○ピクセルの位置は△△メートル」というデータを複数回をサンプリングして近似式を作り、それとカメラ画像を照らし合わせているのです。

こんな感じに↓

以前は職人の手によって調整されていたようです。

しかし、それでは試合に間に合わないので、距離校正の単純化が求められるようになりました。

「サンプル数が少なくても高精度」というやつですか。

夢のような距離校正プログラムですね。

試しにデータを採って見ましょう。

16サンプル採って、Excelに近似曲線を出してもらいました。

指数近似がイイ感じです。

やるじゃないか、Excel。