Commit 64ea81ba authored by wangdawei's avatar wangdawei

test

parent 7e8cf73e
......@@ -1180,6 +1180,7 @@ void Convert::calcPointXYZIT(const pandar_msgs::PandarPacket &packet, int cursor
index += PANDAR128_HEAD_SIZE;
for (int blockid = 0; blockid < header->u8BlockNum; blockid++) {
uint16_t u16Azimuth = *(uint16_t*)(&packet.data[0] + index);
LOG(INFO) << "u16Azimuth: " << u16Azimuth;
// ROS_WARN("#####block.fAzimuth[%u]",u16Azimuth);
index += PANDAR128_AZIMUTH_SIZE;
......@@ -1230,7 +1231,7 @@ void Convert::calcPointXYZIT(const pandar_msgs::PandarPacket &packet, int cursor
} else if (azimuthIdx < 0) {
azimuthIdx += CIRCLE;
}
LOG(INFO) << "azimuthIdx: " << azimuthIdx;
// LOG_EVERY_N(INFO, 10000) << "azimuthIdx: " << azimuthIdx;
point.x = xyDistance * m_fSinAllAngle[azimuthIdx];
point.y = xyDistance * m_fCosAllAngle[azimuthIdx];
......
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