下面这段代码中IMU到Velodyne之间变换关系最后静态的如何去修改成一个固定的矩阵imu_stamped_tf_velo = tf_buffer_ptr-lookupTransformimu_link velo_link rosTime0 rosDuration30; tf2fromMsgimu_stamped_tf_velotransform imu_T_velo;
可以将变换关系转换成一个固定的矩阵,然后将其直接赋值给imu_T_velo或imu_eigen_T_velo。例如:
tf2::Matrix3x3 rotation_matrix(0, 1, 0, -1, 0, 0, 0, 0, 1); // 假设旋转矩阵为这个
tf2::Vector3 translation_vector(1, 0, 0); // 假设平移向量为这个
tf2::Transform imu_T_velo_transform(rotation_matrix, translation_vector);
imu_T_velo = tf2::toMsg(imu_T_velo_transform);
imu_eigen_T_velo = tf2::transformToEigen(imu_T_velo_transform).cast
原文地址: https://www.cveoy.top/t/topic/fdoM 著作权归作者所有。请勿转载和采集!