diff --git a/src/mavlink_interface.cpp b/src/mavlink_interface.cpp
index 13e1c3c..120e255 100644
--- a/src/mavlink_interface.cpp
+++ b/src/mavlink_interface.cpp
@@ -398,7 +398,7 @@ void MavlinkInterface::ReadMAVLinkMessages()
     //std::cerr << "[MavlinkInterface] check message from msg buffer.. " << std::endl;
     auto msg = PopRecvMessage();
     if (msg) {
-      //std::cerr << "[MavlinkInterface] ReadMAVLinkMessages -> handle_message " << std::endl;
+      std::cout << "[MavlinkInterface] ReadMAVLinkMessages -> handle_message " << std::endl;
       handle_message(msg.get());
     }
   } while( (!enable_lockstep_ && !IsRecvBuffEmpty()) ||
@@ -506,6 +506,7 @@ void MavlinkInterface::send_mavlink_message(const mavlink_message_t *message)
     } else {
       len = sendto(fds_[CONNECTION_FD].fd, buffer, packetlen, 0, (struct sockaddr *)&remote_simulator_addr_, remote_simulator_addr_len_);
     }
+    std::cout << "send " << message->msgid << "to " << message->sysid << std::endl;
     if (len < 0) {
       if (received_first_actuator_) {
         std::cerr << "Failed sending mavlink message: " << strerror(errno) << std::endl;