Eigen::Vector3f p_0(184.147, 24.2497, 1); Eigen::Matrix3f lidar2origin_trans;lidar2origin_trans<<0.914117, -0.405448, 144.865, 0.405448, 0.914117, 17.0299 , 0 , 0 , 1;Eigen::Vector3f p_1 = lidar2origin_trans.inverse() * p_0; std::cout<<p1[0] << " " << p_1[1];
时间: 2024-04-07 07:28:07 浏览: 52
matlab.zip_4 3 2 1_eigen matrix
这段代码与之前的代码类似,不同之处在于使用了流式初始化(stream initialization)方式来初始化lidar2origin_trans矩阵,将矩阵元素依次写在“<<”符号的后面。另外,代码中的变量名有误,p1应该改为p_1。整段代码的作用是将一个在Lidar坐标系下的点p_0,通过lidar2origin_trans矩阵的逆变换,转换到原点坐标系下的点p_1,并输出p_1的前两个元素。
阅读全文