Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

GCS_MAVLink: moving sending of sim state up

This commit is contained in:
Peter Barker 2018-01-02 09:21:00 +11:00 committed by Peter Barker
parent a137afd11b
commit e9d2be143a
2 changed files with 23 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

1
libraries/GCS_MAVLink/GCS.h
View File

@ -177,6 +177,7 @@ public:
virtual void send_scaled_pressure3(); // allow sub to override this
void send_scaled_pressure();
void send_sensor_offsets();
virtual void send_simstate() const;
void send_ahrs();
void send_battery2();
#if AP_AHRS_NAVEKF_AVAILABLE

22
libraries/GCS_MAVLink/GCS_Common.cpp
View File

@ -36,6 +36,10 @@
#include <AP_BoardConfig/AP_BoardConfig.h>
#endif
#if CONFIG_HAL_BOARD == HAL_BOARD_SITL
#include <SITL/SITL.h>
#endif
extern const AP_HAL::HAL& hal;
uint32_t GCS_MAVLINK::last_radio_status_remrssi_ms;
@ -2352,6 +2356,17 @@ void GCS_MAVLINK::send_banner()
}
void GCS_MAVLINK::send_simstate() const
{
#if CONFIG_HAL_BOARD == HAL_BOARD_SITL
SITL::SITL *sitl = AP::sitl();
if (sitl == nullptr) {
return;
}
sitl->simstate_send(get_chan());
#endif
}
MAV_RESULT GCS_MAVLINK::handle_command_preflight_set_sensor_offsets(const mavlink_command_long_t &packet)
{
Compass *compass = get_compass();
@ -2873,6 +2888,13 @@ bool GCS_MAVLINK::try_send_message(const enum ap_message id)
send_servo_output_raw();
break;
case MSG_SIMSTATE:
CHECK_PAYLOAD_SIZE(SIMSTATE);
send_simstate();
CHECK_PAYLOAD_SIZE(AHRS2);
send_ahrs2();
break;
case MSG_AHRS:
CHECK_PAYLOAD_SIZE(AHRS);
send_ahrs();