激光驱动修改
原驱动代码
for( std::size_t i=0; i<scandata.distance_data.size(); i++ ) { scanmsg.ranges[i] = float(scandata.distance_data[i])/1000.0f; scanmsg.intensities[i] = scandata.amplitude_data[i]; } scan_publisher_.publish(scanmsg); }
修改角度(逆时针)后
for( std::size_t i=0; i<scandata.distance_data.size(); i++ ) { scanmsg.ranges[i] = float(scandata.distance_data[i])/1000.0f; if(i<10||i>(1440-10)) scanmsg.ranges[i] = std::numeric_limits<float>::infinity(); scanmsg.intensities[i] = scandata.amplitude_data[i]; } scan_publisher_.publish(scanmsg); }
作者:水水滴答
本文版权归作者和博客园共有,欢迎转载,但未经作者同意必须保留此段声明,且在文章页面明显位置给出原文连接,否则保留追究法律责任的权利。