#[cfg(feature = "rclrs_msg")] #[test] fn convertxyz_rclrs_msg() { use ros_pointcloud2::fallible_iterator::FallibleIterator; use ros_pointcloud2::pcl_utils::PointXYZ; use ros_pointcloud2::ros_types::PointCloud2Msg; use ros_pointcloud2::ConvertXYZ; use sensor_msgs::msg::PointCloud2; let cloud = vec![ PointXYZ { x: 1.0, y: 2.0, z: 3.0, }, PointXYZ { x: 4.0, y: 5.0, z: 6.0, }, PointXYZ { x: 7.0, y: 8.0, z: 9.0, }, ]; let copy = cloud.clone(); let internal_cloud: PointCloud2Msg = WriterXYZ::from(cloud).try_into().unwrap(); let rclrs_msg_cloud: PointCloud2 = internal_cloud.into(); let convert_back_internal: PointCloud2Msg = rclrs_msg_cloud.into(); let to_convert = ReaderXYZ::try_from(convert_back_internal).unwrap(); let back_to_type = to_convert.collect::>(); assert_eq!(copy, back_to_type.unwrap()); }