文章目录
4、SingleCamera::workIntrinsicAndExtrinsic()
前言
理论知识可以看北邮鲁鹏老师的课程,哔哩哔哩上有。
一、代码讲解
1、SingleCamera
class SingleCamera {
public:
// 构造函数,初始化成员变量
SingleCamera(Eigen::MatrixXf world_coor, Eigen::MatrixXf pixel_coor, int n)
: world_coor(world_coor), pixel_coor(pixel_coor), point_num(n),
P(Eigen::MatrixXf::Zero(2 * n, 12)), M(Eigen::MatrixXf::Zero(3, 4)),
A(Eigen::MatrixXf::Zero(3, 3)), b(Eigen::MatrixXf::Zero(3, 1)),
K(Eigen::MatrixXf::Zer