def particle_to_pose(particle):
pose = Pose()
pose.position.x = particle[0]
pose.position.y = particle[1]
pose.orientation = angle_to_quaternion(particle[2])
return pose
微信
公众号
扫码关注公众号