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

mavsdk_tests: add events to log

Browse Source
This commit is contained in:
Julian Oes
2025-05-19 07:37:02 -07:00
committed by Ramon Roche
parent 1f65cc46b9
commit d4be5d3ff0
2 changed files with 18 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files
test/mavsdk_tests/autopilot_tester.cpp
+14 -1
View File
@@ -52,6 +52,7 @@ AutopilotTester::AutopilotTester() :
AutopilotTester::~AutopilotTester()
{
_events->unsubscribe_events(_events_handle);
_should_exit = true;
_real_time_report_thread.join();
}
@@ -76,14 +77,26 @@ void AutopilotTester::connect(const std::string uri)
_offboard.reset(new Offboard(system));
_param.reset(new Param(system));
_telemetry.reset(new Telemetry(system));
_events.reset(new Events(system));
_mavlink_passthrough.reset(new MavlinkPassthrough(system));
_events_handle = _events->subscribe_events([](const Events::Event & event) {
std::cout << "[" << event.log_level << "] " << event.message << std::endl;
if (!event.description.empty()) {
std::cout << " Description: " << event.description << std::endl;
}
std::cout << " Event name: " << event.event_namespace << "/" << event.event_name
<< std::endl;
});
}
void AutopilotTester::wait_until_ready()
{
std::cout << time_str() << "Waiting for system to be ready (system health ok & able to arm)" << std::endl;
// Wiat until the system is healthy
// Wait until the system is healthy
CHECK(poll_condition_with_timeout(
[this]() { return _telemetry->health_all_ok(); }, std::chrono::seconds(30)));