Skip to content

L
localize_for_ppk
Commit 68fd6537 authored by wangdawei's avatar wangdawei
Browse files
Options

test

parent 6752fd40
Hide whitespace changes
Inline Side-by-side
Showing with 8 additions and 8 deletions
libs/locate_system/adjust_ppk_by_locate/convert.cc
View file @ 68fd6537
......@@ -437,8 +437,8 @@ void Convert::processGps(pandar_msgs::PandarGps &gpsMsg) {
}
void Convert::pushLiDARData(pandar_msgs::PandarPacket packet) {
// ROS_WARN("Convert::pushLiDARData");
m_PacketsBuffer.push_back(packet);
// ROS_WARN("Convert::pushLiDARData");
m_PacketsBuffer.push_back(packet);
}
int Convert::parseData(Pandar128PacketVersion13 &packet, const uint8_t *recvbuf,
......
libs/locate_system/adjust_ppk_by_locate/convert.h
View file @ 68fd6537
......@@ -333,13 +333,13 @@ typedef struct PacketsBuffer_s {
lastOverflowed = false;
ROS_WARN("buffer recovered");
}
if(((m_iterPush > m_iterTaskEnd) && (m_iterPush - m_iterTaskEnd) > 4 * m_stepSize) ||
((m_iterPush < m_iterTaskBegin) && (m_iterTaskBegin - m_iterPush) < CIRCLE - 4 * m_stepSize)){
// if(((m_iterPush > m_iterTaskEnd) && (m_iterPush - m_iterTaskEnd) > 4 * m_stepSize) ||
// ((m_iterPush < m_iterTaskBegin) && (m_iterTaskBegin - m_iterPush) < CIRCLE - 4 * m_stepSize)){
while((((m_iterPush > m_iterTaskEnd) && (m_iterPush - m_iterTaskEnd) > 4 * m_stepSize) ||
((m_iterPush < m_iterTaskBegin) && (m_iterTaskBegin - m_iterPush) < CIRCLE - 4 * m_stepSize)))
usleep(1000);
}
// while((((m_iterPush > m_iterTaskEnd) && (m_iterPush - m_iterTaskEnd) > 4 * m_stepSize) ||
// ((m_iterPush < m_iterTaskBegin) && (m_iterTaskBegin - m_iterPush) < CIRCLE - 4 * m_stepSize)))
// usleep(1000);
// }
*(m_iterPush++) = pkt;
return 1;
}
......
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