Spiri
/
services-ros1-xbee_mav
12
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

dummy message bug correction

This commit is contained in:
vivek-shankar 2017-01-26 23:10:43 -05:00
parent 025d2a1588
commit 503d5d296f
1 changed files with 4 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
src/CommunicationManager.cpp
View File

@ -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];