Commit 7fbbc345 authored by wangdawei's avatar wangdawei

test

parent a411855a
...@@ -1239,7 +1239,6 @@ void Convert::calcPointXYZIT(const pandar_msgs::PandarPacket &packet, int cursor ...@@ -1239,7 +1239,6 @@ void Convert::calcPointXYZIT(const pandar_msgs::PandarPacket &packet, int cursor
pitchIdx += CIRCLE; pitchIdx += CIRCLE;
} }
azimuthIdx = CIRCLE - azimuthIdx;
float xyDistance = float xyDistance =
distance * m_fCosAllAngle[pitchIdx]; distance * m_fCosAllAngle[pitchIdx];
if(m_bCoordinateCorrectionFlag){ if(m_bCoordinateCorrectionFlag){
...@@ -1255,6 +1254,7 @@ void Convert::calcPointXYZIT(const pandar_msgs::PandarPacket &packet, int cursor ...@@ -1255,6 +1254,7 @@ void Convert::calcPointXYZIT(const pandar_msgs::PandarPacket &packet, int cursor
// LOG_EVERY_N(INFO, 256) << "azimuthIdx: " << azimuthIdx // LOG_EVERY_N(INFO, 256) << "azimuthIdx: " << azimuthIdx
// << " m_fSinAllAngle[azimuthIdx]" << m_fSinAllAngle[azimuthIdx]; // << " m_fSinAllAngle[azimuthIdx]" << m_fSinAllAngle[azimuthIdx];
azimuthIdx = CIRCLE - azimuthIdx;
point.x = xyDistance * m_fSinAllAngle[azimuthIdx]; point.x = xyDistance * m_fSinAllAngle[azimuthIdx];
point.y = xyDistance * m_fCosAllAngle[azimuthIdx]; point.y = xyDistance * m_fCosAllAngle[azimuthIdx];
point.z = distance * m_fSinAllAngle[pitchIdx]; point.z = distance * m_fSinAllAngle[pitchIdx];
......
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