可以将变换关系转换成一个固定的矩阵,然后将其直接赋值给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(); 然后就可以直接使用imu_T_velo或imu_eigen_T_velo进行变换了,不用再查找transform了。

下面这段代码中IMU到Velodyne之间变换关系最后静态的如何去修改成一个固定的矩阵imu_stamped_tf_velo = tf_buffer_ptr-lookupTransformimu_link velo_link rosTime0 rosDuration30; tf2fromMsgimu_stamped_tf_velotransform imu_T_velo;

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

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