OpleGL で正しい変換を取得できません。
point3D - P(X,Y,Z) と射影行列 M があります。これは K*(R|T) に等しく、
K - カメラ キャリブレーション マトリックス
(R|T) - ポイント (オブジェクト) 座標系の変換 (R - 回転行列、T - 並進ベクトル)
その結果、点を p = M*P として射影しました。
私は P、K、R、T を知っていますが、OpenGl 用語で p を計算することはありません。
OpenCV 用語では、次のようになります (小さな抽象化コード)。
CvMat* R = cvCreateMat(4,4, CV_32F, getRotationData());
CvMat* T = cvCreateMat(4,1, CV_32F, getTranslationData());
CvMat* K = cvCreateMat(4,4, CV_32F, getCameraCalibrationData());
// (R|T)
R->data.fl[3] = T->data.fl[0];
R->data.fl[7] = T->data.fl[1];
R->data.fl[11] = T->data.fl[2];
R->data.fl[15] = T->data.fl[3];
CvMat M = cvMat(4,4, CV_32F);
// M = R*(R|T)
cvMulMat(K, R, &M);
CvMat* P = cvCreateMat(4,1, CV_32F, getTestedPoint3D());
cvMar p = cvMat(4,1, CV_32F); // result transformation
// p = M*P
cvMulMat(&M, P, &p);
// project
float z = p.data.fl[2];
float x = p.data.fl[0] / z;
float y = p.data.fl[1] / z;
printf("Point projection [%f,%f]", x, y);
cvDrawPonit(img, cvPoint(x,y), CV_RGB(255,0,0)); /// <- !!!!
このロジックを OpenGl に変換するにはどうすればよいですか?
GL_PROJECTION を設定するにはどうすればよいですか? GL_MODELVIEW モードなどで何ができますか?