思岚s1雷达角度裁剪

在src目录下的node.cpp文件中,通过宏定义设置所需角度,然后在publish_scan函数内部,对扫描消息的每个角度进行判断,当角度在设定范围内时,将范围值设为无穷大。此操作用于定制化激光扫描数据处理。

摘要生成于 C知道 ,由 DeepSeek-R1 满血版支持, 前往体验 >

找到src里面的node.cpp,添加以下代码

  1. 前面加入宏定义,z就是你想要的角度

    #define z 100 //CuttingAngle
    #define Z (180-z)/180
    
  2. 然后在publish_scan函数中加入

       
        for(int i=0;i<scan_msg.ranges.size();i++)
        {
    	if(((scan_msg.angle_min+i*scan_msg.angle_increment)>-M_PI*Z)&&((scan_msg.angle_min+i*scan_msg.angle_increment)<M_PI*Z))
        {
    	scan_msg.ranges[i]=std::numeric_limits<float>::infinity();
        }	
    	
        }
    
    
  3. 最后重新编译运行

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值