Commit 6b0f246c authored by wangdawei's avatar wangdawei

test

parent 96731934
...@@ -206,14 +206,16 @@ bool Convert::processScan( ...@@ -206,14 +206,16 @@ bool Convert::processScan(
const pandar_msgs::PandarScan::ConstPtr &scanMsg, PPointCloud &pc) const pandar_msgs::PandarScan::ConstPtr &scanMsg, PPointCloud &pc)
{ {
LOG(INFO) << "scanMsg->packets.size(): " << scanMsg->packets.size(); LOG(INFO) << "scanMsg->packets.size(): " << scanMsg->packets.size();
init(); if(0 == scanMsg->packets.size()){
return false;
}
if(!inited){
init(scanMsg->packets[0]);
inited = true;
}
m_OutMsgArray[0]->clear(); m_OutMsgArray[0]->clear();
m_OutMsgArray[0]->resize(CIRCLE_ANGLE / m_iAngleSize * m_iLaserNum * m_iReturnBlockSize ); m_OutMsgArray[0]->resize(CIRCLE_ANGLE / m_iAngleSize * m_iLaserNum * m_iReturnBlockSize );
for (size_t next = 0; next < scanMsg->packets.size(); ++next) { for (size_t next = 0; next < scanMsg->packets.size(); ++next) {
if(!inited){
init(scanMsg->packets[next]);
inited = true;
}
calcPointXYZIT(scanMsg->packets[next], 0); calcPointXYZIT(scanMsg->packets[next], 0);
} }
m_OutMsgArray[0]->header.frame_id = m_sFrameId; m_OutMsgArray[0]->header.frame_id = m_sFrameId;
......
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment