将投影矩阵P分解为A(本质矩阵)，R(旋转矩阵)，T(平移矩阵)

最新推荐文章于 2023-04-26 22:50:12 发布

fsencen

最新推荐文章于 2023-04-26 22:50:12 发布

阅读量7.8k

点赞数 2

分类专栏：三维重建

本文链接：https://blog.csdn.net/fsencen/article/details/79416630

版权

最近在做3D重建的毕业设计，写代码写到想吐。老师感觉原来的那个数据集不太好，叫我换了一个，没办法只好换掉，摄像机的参数又要重新搞，有点烦。还好数据集里面已经标定好了参数，可以直接读取，省了我不少功夫。可是问题又来了，他只给出了摄像机矩阵P，只能想办法把他分解成A,R,T的形式。

下面开始正题：怎么从P中分解出A,R,T

qr分解在有很多种办法，在Matlab中更是有现成的qr()函数，直接调用就可以，省去了不少功夫。但是在C++实现的，在网上搜了好久也没有搜到，最后只好自己动手了，代码挺短，但是还是写了很久，能力有限。

本代码是基于opencv2.4.9中的Mat矩阵进行编写的，经过测试，和Matlab中的qr（）函数结果一致。

int sign(double x)
{
  if(x < 0) return -1;
  else return 1;
}

void householder(Mat x, Mat y, Mat& H)
{
  Mat u,I;
  y = -sign(x.at<double>(

关注