diff --git a/src/CommunicationManager.cpp b/src/CommunicationManager.cpp index f04f6ed..368c729 100644 --- a/src/CommunicationManager.cpp +++ b/src/CommunicationManager.cpp @@ -370,7 +370,7 @@ inline void CommunicationManager::Check_In_Messages_and_Transfer_To_Topics() ¤t_int64); header = u64_cvt_u16(current_int64); uint16_t checksum_cur=header[1]; - + std::cout << "Received header" <size(); i++) { @@ -383,12 +383,13 @@ inline void CommunicationManager::Check_In_Messages_and_Transfer_To_Topics() } } - std::cout << "Single packet message" << std::endl; + std::cout << "Single packet message received" << std::endl; mavlink_publisher_.publish(mavlink_msg); delete[] header; } else{ std::cout << "Multi packet message" << std::endl; + if (msgs.size()==0 && header[2]==1){ std::cout << "first message" << std::endl; checksum_cur=header[1]; @@ -549,7 +550,7 @@ inline void CommunicationManager::Send_Mavlink_Message_Callback( cnt++; } else - { + { std::cout << "Multi frame sent no:"<