diff --git a/libraries/GCS_MAVLink/GCS.h b/libraries/GCS_MAVLink/GCS.h index d2ecb11738..328aa8da6c 100644 --- a/libraries/GCS_MAVLink/GCS.h +++ b/libraries/GCS_MAVLink/GCS.h @@ -180,6 +180,7 @@ public: // common send functions void send_meminfo(void); + void send_power_status(void); private: void handleMessage(mavlink_message_t * msg); @@ -280,7 +281,6 @@ private: void handle_log_send(DataFlash_Class &dataflash); void handle_log_send_listing(DataFlash_Class &dataflash); bool handle_log_send_data(DataFlash_Class &dataflash); - }; #endif // __GCS_H diff --git a/libraries/GCS_MAVLink/GCS_Common.cpp b/libraries/GCS_MAVLink/GCS_Common.cpp index 37d49adf6f..64a0e501bb 100644 --- a/libraries/GCS_MAVLink/GCS_Common.cpp +++ b/libraries/GCS_MAVLink/GCS_Common.cpp @@ -149,3 +149,13 @@ void GCS_MAVLINK::send_meminfo(void) mavlink_msg_meminfo_send(chan, __brkval, hal.util->available_memory()); } +// report power supply status +void GCS_MAVLINK::send_power_status(void) +{ +#ifdef CONFIG_ARCH_BOARD_PX4FMU_V2 + mavlink_msg_power_status_send(chan, + hal.analogin->board_voltage() * 1000, + hal.analogin->servorail_voltage() * 1000, + hal.analogin->power_status_flags()); +#endif +}