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

xbee send and recive framse partly working

This commit is contained in:
vivek-shankar 2017-01-27 02:43:25 -05:00
parent 8a0f93dce2
commit fae7d245c7
1 changed files with 4 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
src/CommunicationManager.cpp
View File

@ -415,9 +415,9 @@ inline void CommunicationManager::Check_In_Messages_and_Transfer_To_Topics()
for(uint16_t i =1; i<=header[3];i++){ for(uint16_t i =1; i<=header[3];i++){
it = multi_msgs.find(i); it = multi_msgs.find(i);
std::cout<<"Transfering to topic chunk no. :"<<it->first << "Size of current map" <<it->second->size()<< std::endl; std::cout<<"Transfering to topic chunk no. :"<<it->first << "Size of current map" <<it->second->size()<< std::endl;
std::cout << "received Frame:"<<it->second << std::endl; std::cout << "received Frame:"<<(void *) it->second->c_str() << std::endl;
std::cout<<"Size of map : "<< multi_msgs.size()<< std::endl; std::cout<<"Size of map : "<< multi_msgs.size()<< std::endl;
for (std::size_t j = 1; j < it->second->size(); j++) for (std::size_t j = 1; j < it->second->size()-1; j++)
{ {
@ -425,6 +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;
mavlink_msg.payload64.push_back(current_int64); mavlink_msg.payload64.push_back(current_int64);
} }
@ -546,6 +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;
} }