fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-05-15 23:17:34 +08:00
Code Issues Packages Projects Releases Wiki Activity

commander: use PX4_INFO for status output

Browse Source
This commit is contained in:
Beat Küng
2018-08-06 08:12:18 +02:00
committed by Lorenz Meier
parent f1dc8f8f48
commit 26f11cb9d7
1 changed files with 8 additions and 8 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/commander/Commander.cpp
+8 -8
View File
@@ -502,15 +502,15 @@ void usage(const char *reason)
void print_status()
{
warnx("type: %s", (status.is_rotary_wing) ? "symmetric motion" : "forward motion");
warnx("safety: USB enabled: %s, power state valid: %s", (status_flags.usb_connected) ? "[OK]" : "[NO]",
PX4_INFO("type: %s", (status.is_rotary_wing) ? "symmetric motion" : "forward motion");
PX4_INFO("safety: USB enabled: %s, power state valid: %s", (status_flags.usb_connected) ? "[OK]" : "[NO]",
(status_flags.condition_power_input_valid) ? " [OK]" : "[NO]");
warnx("home: lat = %.7f, lon = %.7f, alt = %.2f, yaw: %.2f", _home.lat, _home.lon, (double)_home.alt, (double)_home.yaw);
warnx("home: x = %.7f, y = %.7f, z = %.2f ", (double)_home.x, (double)_home.y, (double)_home.z);
warnx("datalink: %s %s", (status.data_link_lost) ? "LOST" : "OK", (status.high_latency_data_link_active) ? "(high latency)" : " ");
warnx("main state: %d", internal_state.main_state);
warnx("nav state: %d", status.nav_state);
warnx("arming: %s", arming_state_names[status.arming_state]);
PX4_INFO("home: lat = %.7f, lon = %.7f, alt = %.2f, yaw: %.2f", _home.lat, _home.lon, (double)_home.alt, (double)_home.yaw);
PX4_INFO("home: x = %.7f, y = %.7f, z = %.2f ", (double)_home.x, (double)_home.y, (double)_home.z);
PX4_INFO("datalink: %s %s", (status.data_link_lost) ? "LOST" : "OK", (status.high_latency_data_link_active) ? "(high latency)" : " ");
PX4_INFO("main state: %d", internal_state.main_state);
PX4_INFO("nav state: %d", status.nav_state);
PX4_INFO("arming: %s", arming_state_names[status.arming_state]);
}
static orb_advert_t status_pub;