MAVLink: Add verbose command

This commit is contained in:
Beat Küng
2017-08-04 18:08:51 +02:00
committed by Lorenz Meier
parent 32491626b6
commit 371586be2c
3 changed files with 54 additions and 2 deletions
+8
View File
@@ -2412,6 +2412,9 @@ MavlinkReceiver::receive_thread(void *arg)
ssize_t nread = 0;
hrt_abstime last_send_update = 0;
bool verbose = _mavlink->get_verbose();
_mission_manager.set_verbose(verbose);
while (!_mavlink->_task_should_exit) {
if (poll(&fds[0], 1, timeout) > 0) {
if (_mavlink->get_protocol() == SERIAL) {
@@ -2510,6 +2513,11 @@ MavlinkReceiver::receive_thread(void *arg)
_mavlink_ftp.send(t);
_mavlink_log_handler.send(t);
last_send_update = t;
if (verbose != _mavlink->get_verbose()) {
verbose = !verbose;
_mission_manager.set_verbose(verbose);
}
}
}