Compare commits

...

1 Commits

Author SHA1 Message Date
7e70a03bc0 fix bug nan in function transformLaserScanToPointCloud_ 2026-03-11 09:06:16 +00:00

View File

@@ -463,6 +463,15 @@ void LaserProjection::transformLaserScanToPointCloud_(
tf3::Vector3 origin_end(end_transform.transform.translation.x, tf3::Vector3 origin_end(end_transform.transform.translation.x,
end_transform.transform.translation.y, end_transform.transform.translation.y,
end_transform.transform.translation.z); end_transform.transform.translation.z);
if(target_frame == scan_in.header.frame_id)
{
quat_start = tf3::Quaternion(0, 0, 0, 1);
quat_end = tf3::Quaternion(0, 0, 0, 1);
origin_start = tf3::Vector3(0, 0, 0);
origin_end = tf3::Vector3( 0, 0, 0);
}
transformLaserScanToPointCloud_( transformLaserScanToPointCloud_(
target_frame, scan_in, cloud_out, target_frame, scan_in, cloud_out,
quat_start, origin_start, quat_start, origin_start,