3D框显示
3D框显示可以使用visualization_msgs::Marker::LINE_LIST或者LINE_STRIP,前者使用方法需要指明线的两个端点,后者自动连接相邻两个点。
姿态问题
网上看了一些,没有涉及到朝向设置,Pose.orientation默认构造为4个0
至少需要设置实部Pose.orientation.w = 1.f;对于3Dbox是有姿态的,我直接拿世界坐标系下的姿态赋值,但是最坑的是,内部会默认进行左乘一个旋转,导致实际显示的3d box位置为 R*t,为了抵消这个R,所以程序中先对三维坐标t乘个R逆。不知道是不是我使用上有问题,或者有没有更好的方法??
最终正确的效果: