diff --git a/src/modules/mc_pos_control/mc_pos_control_main.cpp b/src/modules/mc_pos_control/mc_pos_control_main.cpp index ba80c874510735660f94346438b11ff38b9467fe..c220a0959dcd9bf2e90825ff5d72ef780b18dd4b 100644 --- a/src/modules/mc_pos_control/mc_pos_control_main.cpp +++ b/src/modules/mc_pos_control/mc_pos_control_main.cpp @@ -95,6 +95,9 @@ public: /** @see ModuleBase::run() */ void run() override; + /** @see ModuleBase::print_status() */ + int print_status() override; + private: bool _in_smooth_takeoff = false; /**<true if takeoff ramp is applied */ @@ -556,6 +559,17 @@ MulticopterPositionControl::set_vehicle_states(const float &vel_sp_z) } +int +MulticopterPositionControl::print_status() +{ + if (_flight_tasks.isAnyTaskActive()) { + PX4_INFO("Running, active flight task: %i", _flight_tasks.getActiveTask()); + } else { + PX4_INFO("Running, no flight task active"); + } + return 0; +} + void MulticopterPositionControl::run() {