ros顺逆时针点云转换

laser_scan的const指针转换为普通指针

void laserScanCallback(const sensor_msgs::LaserScanConstPtr& scan)
{
    // 将const指针转换为非const指针
    sensor_msgs::LaserScanPtr scanPtr = boost::const_pointer_cast<sensor_msgs::LaserScan>(scan);
    // 在这里可以对scanPtr进行修改或使用
    // ...
}

点云顺序转换

sensor_msgs::LaserScanPtr scan_ptr(new sensor_msgs::LaserScan);

    // 复制 scan_const_ptr 的数据到 scan_ptr
    *scan_ptr = *scan_const_ptr;

    // 反转点云距离顺序
    std::reverse(scan_ptr->ranges.begin(), scan_ptr->ranges.end());
    //反转点云强度顺序
    std::reverse(scan_ptr->intensities.begin(), scan_ptr->intensities.end());
  • 10
    点赞
  • 7
    收藏
    觉得还不错? 一键收藏
  • 1
    评论
评论 1
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值