Skip to content

Commit

Permalink
update
Browse files Browse the repository at this point in the history
  • Loading branch information
haitomatic committed Nov 7, 2023
1 parent d3c32d6 commit c255514
Showing 1 changed file with 2 additions and 1 deletion.
3 changes: 2 additions & 1 deletion src/mavlink_interface.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -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()) ||
Expand Down Expand Up @@ -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;
Expand Down

0 comments on commit c255514

Please sign in to comment.