2009/02/13

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

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

距離校正の話は今日で終わりです。

では、距離校正の実験を始めます。

0.3m~5.0mを計測した結果が下のグラフです。青色の点が1回目(サンプリング)、ピンクの点が2回目(実測値)です。

思い通り。

素晴らしい出来です。

ただ、残念なのは、5m以上のメジャーが無かったことです。

まぁ、でも実際、5m以上離れると「1ピクセル動いたら1メートル」の世界になるので、距離を求めても、おそらく精度はあまり良くないでしょう。

実際はこの様ように映ります
以上で距離校正の話を終わります。

2009/02/12

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

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

まずは下のグラフを見てください。赤が指数近似、青が多項式近似です。



指数近似は距離が離れるにしたがって誤差が大きくなっていくのに対し、多項式近似では遠距離でも安定して近似できています。精度もなかなかのものです。

でも、ちょっと待ってください。

多項式近似の近距離部分、中心からのピクセル数で言うと25ピクセルより前の部分です。

ピクセル数が小さくなっているのにも関わらず、距離が大きくなっています。

ここなんですよ、多項式近似の怖いところは。

この改善についてはいろいろ考えました。

例えば「近・中距離は指数、遠距離は多項式」とか、「指数と多項式の平均」とか。

ですが、どれも理想的な形にならないんですよ。書くコードの量も無駄に増えてしまいうわけですし。

そこでですね、見えない部分にダミーデータを配置するようにしました。さらに、6次多項式にして精度を上げます。

最終的な結果はコチラ↓


す ば ら し い。

キレイな近似曲線が出ています。

コレいけんるんじゃないですか?

2009/02/11

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

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

ここを参考にして作った「n次多項式近似のプログラム」です。

const int num = 16;

double distance[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[num] = { 21, 27, 31, 37, 42, 44, 46, 50, 62, 68, 74, 76, 80, 82, 84, 84, 86};

// n次多項式近似 ///////////////////////////////////////////////////////
const int N = 5; // N-1次の多項式近似
double x[N];
double a[N][N+1];
double b[1][N+1];

for (int i = 0; i < N; i++) {
    for (int j = 0; j < N + 1; j++) {
        a[i][j] = 0.0;
    }
}
for (int i = 0; i < N; i++) {
    for (int j = 0; j < N; j++) {
        for (int k = 0; k < num; k++) {
            a[i][j] += pow((double)pixels[k], (double)(i + j));
        }
    }
}
for (int i = 0; i < N; i++) {
    for (int j = 0; j < num; j++) {
        a[i][N] += pow((double)pixels[j], (double)i) * distance[j];
    }
}
for (int i = 0; i < N; i++) {
    double m = 0;
    int pivot = i;
    for (int j = i; j < N; j++) {
        if (fabs(a[j][i]) > m) {
            m = fabs(a[j][i]);
            pivot = j;
        }
    }
    if (pivot != i) {
        for(int j = 0; j < N+1; j++) {
            b[0][j] = a[i][j];
            a[i][j] = a[pivot][j];
            a[pivot][j] = b[0][j];
        }
    }
}
for (int k = 0; k < N; k++) {
    double p = a[k][k];
    a[k][k] = 1;
    for (int j = k+1; j < N+1; j++) a[k][j] /= p;
    for (int i = k+1; i < N; i++) {
        double q = a[i][k];
        for (int j = k+1; j < N+1; j++) a[i][j] -= q*a[k][j];
        a[i][k] = 0;
    }
}
for (int i = N-1; i >= 0; i--) {
    x[i] = a[i][N];
    for (int j = N-1; j > i; j--) x[i] -= a[i][j]*x[j];
}
//////////////////////////////////////////////////////////////////////

これで、
r = 中心からのピクセル数
y = x[4]*r*r*r*r+ x[3]*r*r*r+ x[2]*r*r+ x[1]*r+ x[0];
で距離yがでます。