可以将变换关系转换成一个固定的矩阵,然后将其直接赋值给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<float>();

然后就可以直接使用imu_T_velo或imu_eigen_T_velo进行变换了,不用再查找transform了。

ROS中IMU到Velodyne之间变换关系的固定矩阵实现

原文地址: https://www.cveoy.top/t/topic/n5Ri 著作权归作者所有。请勿转载和采集!

免费AI点我,无需注册和登录