Spiri
/
XbeeMav
Archived
13
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

Debug of corrupted messages found from rosbuzz test failour on update

This commit is contained in:
vivek-shankar 2017-01-27 23:09:31 -05:00
parent e85c10a84a
commit 5dc7aca4e7
1 changed files with 7 additions and 7 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

14
src/CommunicationManager.cpp
View File

@ -400,11 +400,11 @@ inline void CommunicationManager::Check_In_Messages_and_Transfer_To_Topics()
} }
else if (header[1]==cur_checksum) { else if (header[1]==cur_checksum) {
std::map< std::size_t, std::shared_ptr<std::string> >::iterator it = multi_msgs.find(header[2]); std::map< std::size_t, std::shared_ptr<std::string> >::iterator it = multi_msgs.find(header[2]);
if(it!=multi_msgs.end()){ //if(it!=multi_msgs.end()){
multi_msgs.erase(it); //multi_msgs.erase(it);
multi_msgs.insert(make_pair(header[2], in_message)); //multi_msgs.insert(make_pair(header[2], in_message));
} //}
else{ if(it==multi_msgs.end()){
multi_msgs.insert(make_pair(header[2], in_message)); multi_msgs.insert(make_pair(header[2], in_message));
counter++; counter++;
} }
@ -425,7 +425,7 @@ inline void CommunicationManager::Check_In_Messages_and_Transfer_To_Topics()
{ {
sscanf(it->second->c_str() + j, "%" PRIu64 " ", sscanf(it->second->c_str() + j, "%" PRIu64 " ",
&current_int64); &current_int64);
//std::cout << "received Frame:" << current_int64 << std::endl; std::cout << "received Frame:" << current_int64 << std::endl;
mavlink_msg.payload64.push_back(current_int64); mavlink_msg.payload64.push_back(current_int64);
} }
@ -547,7 +547,7 @@ inline void CommunicationManager::Send_Mavlink_Message_Callback(
converted_bytes += sprintf( converted_bytes += sprintf(
temporary_buffer+converted_bytes, "%" PRIu64 " ", temporary_buffer+converted_bytes, "%" PRIu64 " ",
(uint64_t)mavlink_msg->payload64.at(i)); (uint64_t)mavlink_msg->payload64.at(i));
//std::cout << "Frame:"<<mavlink_msg->payload64.at(i) << std::endl; std::cout << "Sent Frame:"<<mavlink_msg->payload64.at(i) << std::endl;
} }