35 lines
1.1 KiB
Rust
35 lines
1.1 KiB
Rust
#[cfg(feature = "r2r_msg")]
|
|
#[test]
|
|
fn convertxyz_r2r_msg() {
|
|
use r2r::sensor_msgs::msg::PointCloud2;
|
|
use ros_pointcloud2::fallible_iterator::FallibleIterator;
|
|
use ros_pointcloud2::pcl_utils::PointXYZ;
|
|
use ros_pointcloud2::ros_types::PointCloud2Msg;
|
|
use ros_pointcloud2::ConvertXYZ;
|
|
|
|
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 = ConvertXYZ::try_from(cloud).unwrap().try_into().unwrap();
|
|
let r2r_msg_cloud: PointCloud2 = internal_cloud.into();
|
|
let convert_back_internal: PointCloud2Msg = r2r_msg_cloud.into();
|
|
let to_convert: ConvertXYZ = ConvertXYZ::try_from(convert_back_internal).unwrap();
|
|
let back_to_type = to_convert.map(|point| Ok(point)).collect::<Vec<PointXYZ>>();
|
|
assert_eq!(copy, back_to_type.unwrap());
|
|
}
|