Compare commits
1 Commits
50062ef549
...
main
| Author | SHA1 | Date | |
|---|---|---|---|
| 7e70a03bc0 |
@@ -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,
|
||||||
|
|||||||
Reference in New Issue
Block a user