Spiri
/
services-ros1-xbee_mav
12
0
Fork 0
Code Issues Pull Requests Actions Packages 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) {
std::map< std::size_t, std::shared_ptr<std::string> >::iterator it = multi_msgs.find(header[2]);
if(it!=multi_msgs.end()){
multi_msgs.erase(it);
multi_msgs.insert(make_pair(header[2], in_message));
}
else{
//if(it!=multi_msgs.end()){
//multi_msgs.erase(it);
//multi_msgs.insert(make_pair(header[2], in_message));
//}
if(it==multi_msgs.end()){
multi_msgs.insert(make_pair(header[2], in_message));
counter++;
}
@ -425,7 +425,7 @@ inline void CommunicationManager::Check_In_Messages_and_Transfer_To_Topics()
{
sscanf(it->second->c_str() + j, "%" PRIu64 " ",
&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);
}
@ -547,7 +547,7 @@ inline void CommunicationManager::Send_Mavlink_Message_Callback(
converted_bytes += sprintf(
temporary_buffer+converted_bytes, "%" PRIu64 " ",
(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;
}