dummy message bug correction
This commit is contained in:
parent
025d2a1588
commit
503d5d296f
|
@ -355,8 +355,8 @@ inline void CommunicationManager::Check_In_Messages_and_Transfer_To_Topics()
|
||||||
uint16_t* header;
|
uint16_t* header;
|
||||||
if (size_in_messages > 0)
|
if (size_in_messages > 0)
|
||||||
{
|
{
|
||||||
//steps++;
|
steps++;
|
||||||
//if(steps==100) steps=0;
|
if(steps==100) steps=0;
|
||||||
uint64_t current_int64 = 0;
|
uint64_t current_int64 = 0;
|
||||||
for (std::size_t j = 0; j < size_in_messages; j++)
|
for (std::size_t j = 0; j < size_in_messages; j++)
|
||||||
{
|
{
|
||||||
|
@ -385,10 +385,10 @@ inline void CommunicationManager::Check_In_Messages_and_Transfer_To_Topics()
|
||||||
mavlink_publisher_.publish(mavlink_msg);
|
mavlink_publisher_.publish(mavlink_msg);
|
||||||
delete[] header;
|
delete[] header;
|
||||||
}
|
}
|
||||||
else{
|
else if (header[3]>1){
|
||||||
std::cout << "Multi packet: check_cur:"<<cur_checksum<< std::endl;
|
std::cout << "Multi packet: check_cur:"<<cur_checksum<< std::endl;
|
||||||
|
|
||||||
if (multi_msgs.end()==0){
|
if (multi_msgs.empty()){
|
||||||
std::cout << "first message" << std::endl;
|
std::cout << "first message" << std::endl;
|
||||||
multi_msgs.insert(make_pair(header[2], in_message));
|
multi_msgs.insert(make_pair(header[2], in_message));
|
||||||
cur_checksum=header[1];
|
cur_checksum=header[1];
|
||||||
|
|
Reference in New Issue