diff --git a/src/CommunicationManager.cpp b/src/CommunicationManager.cpp index 3012b2f..bda82f4 100644 --- a/src/CommunicationManager.cpp +++ b/src/CommunicationManager.cpp @@ -427,7 +427,7 @@ inline void CommunicationManager::Check_In_Messages_and_Transfer_To_Server() // inline void CommunicationManager::Send_Mavlink_Message_Callback( const mavros_msgs::Mavlink::ConstPtr& mavlink_msg) { - std::cout << "Received Message From Buzz" << std::endl; // TO DO delete + //std::cout << "Received Message From Buzz" << std::endl; // TO DO delete packets_handler_.Handle_Mavlink_Message(mavlink_msg); } diff --git a/src/PacketsHandler.cpp b/src/PacketsHandler.cpp index b219a9b..0bd0ed9 100644 --- a/src/PacketsHandler.cpp +++ b/src/PacketsHandler.cpp @@ -106,7 +106,7 @@ void PacketsHandler::Handle_Mavlink_Message(const mavros_msgs::Mavlink::ConstPtr fragmented_packet->at(i)->append(serialized_packet->c_str() + offset, NBR_of_bytes); offset += NBR_of_bytes; } - + std::cout << "[Debug: ] Multi packets received from buzz" << std::endl; out_packets_.Push_Back({mavlink_msg->msgid, fragmented_packet}); } else if (serialized_packet->size() < XBEE_NETWORK_MTU) @@ -126,7 +126,7 @@ void PacketsHandler::Process_Fragment(std::shared_ptr fragment) uint16_t offset = static_cast( static_cast(static_cast(fragment->at(4))) << 8 | static_cast(static_cast(fragment->at(5)))); - + std::cout << "[Debug: ] Fragment received with id"<< fragment_ID<< std::endl; assembly_map_it_ = packets_assembly_map_.find(node_8_bits_address); if (assembly_map_it_ != packets_assembly_map_.end()) @@ -415,7 +415,7 @@ void PacketsHandler::Process_Out_Packets() { Process_Out_Standard_Messages(); out_packet = out_packets_.Pop_Front(); - + std::cout << "Multi packets sending" << std::endl; Send_Packet(out_packet); } }