From 8a6a5cc3103b9c47cecfb56b4421fe5ed16d4f57 Mon Sep 17 00:00:00 2001 From: mcsauder Date: Tue, 19 Feb 2019 10:39:03 -0700 Subject: [PATCH] Deprecate #defines that are not needed, format whitespace and minor (incomplete) alphebetization of a few lists. --- src/modules/mavlink/mavlink_receiver.cpp | 52 +++++------------------- src/modules/mavlink/mavlink_receiver.h | 33 +++++++++------ 2 files changed, 32 insertions(+), 53 deletions(-) diff --git a/src/modules/mavlink/mavlink_receiver.cpp b/src/modules/mavlink/mavlink_receiver.cpp index 1d1acf49cb..2fe17e4231 100644 --- a/src/modules/mavlink/mavlink_receiver.cpp +++ b/src/modules/mavlink/mavlink_receiver.cpp @@ -40,33 +40,18 @@ * @author Thomas Gubler */ -/* XXX trim includes */ -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include +#include +#include +#include #include +#include #include +#include #include -#include #include #include #include -#include -#include -#include -#ifndef __PX4_POSIX -#include -#endif +#include #ifdef CONFIG_NET #include @@ -74,11 +59,6 @@ #include #endif -#include -#include -#include - -#include #ifdef __PX4_DARWIN #include #include @@ -86,23 +66,13 @@ #include #endif -#include -#include -#include -#include -#include -#include -#include - -#include - -#include -#include +#ifndef __PX4_POSIX +#include +#endif -#include "mavlink_bridge_header.h" -#include "mavlink_receiver.h" -#include "mavlink_main.h" #include "mavlink_command_sender.h" +#include "mavlink_main.h" +#include "mavlink_receiver.h" #ifdef CONFIG_NET #define MAVLINK_RECEIVER_NET_ADDED_STACK 1360 diff --git a/src/modules/mavlink/mavlink_receiver.h b/src/modules/mavlink/mavlink_receiver.h index b720f49175..b94c068b6c 100644 --- a/src/modules/mavlink/mavlink_receiver.h +++ b/src/modules/mavlink/mavlink_receiver.h @@ -50,10 +50,10 @@ #include #include #include +#include #include #include #include -#include #include #include #include @@ -67,13 +67,12 @@ #include #include #include -#include -#include #include -#include +#include #include #include #include +#include #include #include #include @@ -82,6 +81,7 @@ #include #include #include +#include #include "mavlink_ftp.h" #include "mavlink_log_handler.h" @@ -107,7 +107,7 @@ public: /** * Display the mavlink status. */ - void print_status(); + void print_status(); /** * Start the receiver thread @@ -128,11 +128,13 @@ private: template void handle_message_command_both(mavlink_message_t *msg, const T &cmd_mavlink, const vehicle_command_s &vehicle_command); + + void handle_message_adsb_vehicle(mavlink_message_t *msg); + void handle_message_att_pos_mocap(mavlink_message_t *msg); void handle_message_command_ack(mavlink_message_t *msg); void handle_message_optical_flow_rad(mavlink_message_t *msg); void handle_message_hil_optical_flow(mavlink_message_t *msg); void handle_message_set_mode(mavlink_message_t *msg); - void handle_message_att_pos_mocap(mavlink_message_t *msg); void handle_message_vision_position_estimate(mavlink_message_t *msg); void handle_message_gps_global_origin(mavlink_message_t *msg); void handle_message_set_position_target_local_ned(mavlink_message_t *msg); @@ -149,7 +151,6 @@ private: void handle_message_distance_sensor(mavlink_message_t *msg); void handle_message_follow_target(mavlink_message_t *msg); void handle_message_landing_target(mavlink_message_t *msg); - void handle_message_adsb_vehicle(mavlink_message_t *msg); void handle_message_collision(mavlink_message_t *msg); void handle_message_gps_rtcm_data(mavlink_message_t *msg); void handle_message_battery_status(mavlink_message_t *msg); @@ -189,7 +190,7 @@ private: */ int decode_switch_pos_n(uint16_t buttons, unsigned sw); - bool evaluate_target_ok(int command, int target_system, int target_component); + bool evaluate_target_ok(int command, int target_system, int target_component); void send_flight_information(); @@ -201,13 +202,15 @@ private: MavlinkParametersManager _parameters_manager; MavlinkFTP _mavlink_ftp; MavlinkLogHandler _mavlink_log_handler; - MavlinkTimesync _mavlink_timesync; + MavlinkTimesync _mavlink_timesync; mavlink_status_t _status; ///< receiver status, used for mavlink_parse_char() + struct vehicle_attitude_s _att; struct vehicle_local_position_s _hil_local_pos; struct vehicle_land_detected_s _hil_land_detector; struct vehicle_control_mode_s _control_mode; + orb_advert_t _global_pos_pub; orb_advert_t _local_pos_pub; orb_advert_t _attitude_pub; @@ -245,19 +248,25 @@ private: orb_advert_t _debug_value_pub; orb_advert_t _debug_vect_pub; orb_advert_t _debug_array_pub; - static const int _gps_inject_data_queue_size = 6; orb_advert_t _gps_inject_data_pub; orb_advert_t _command_ack_pub; - int _control_mode_sub; + + static const int _gps_inject_data_queue_size = 6; + int _actuator_armed_sub; + int _control_mode_sub; + int _hil_frames; int _vehicle_attitude_sub; + uint64_t _global_ref_timestamp; - int _hil_frames; uint64_t _old_timestamp; + bool _hil_local_proj_inited; float _hil_local_alt0; + struct map_projection_reference_s _hil_local_proj_ref; struct offboard_control_mode_s _offboard_control_mode; + int _orb_class_instance; static constexpr unsigned MOM_SWITCH_COUNT = 8;