mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-13 23:43:33 +08:00
Offboard mode working
This commit is contained in:
@@ -99,6 +99,9 @@ FixedWingGuidanceControl::parameters_update()
|
||||
void
|
||||
FixedWingGuidanceControl::vehicle_control_mode_poll()
|
||||
{
|
||||
if (_control_mode_sub.updated()) {
|
||||
_control_mode_sub.copy(&_control_mode);
|
||||
}
|
||||
}
|
||||
|
||||
void
|
||||
@@ -294,6 +297,13 @@ FixedWingGuidanceControl::Run()
|
||||
|
||||
vehicle_global_position_s gpos;
|
||||
|
||||
airspeed_poll();
|
||||
manual_control_setpoint_poll();
|
||||
vehicle_attitude_poll();
|
||||
vehicle_control_mode_poll();
|
||||
wind_poll(now);
|
||||
|
||||
|
||||
if (_global_pos_sub.update(&gpos)) {
|
||||
_current_latitude = gpos.lat;
|
||||
_current_longitude = gpos.lon;
|
||||
@@ -388,12 +398,6 @@ FixedWingGuidanceControl::Run()
|
||||
}
|
||||
}
|
||||
|
||||
airspeed_poll();
|
||||
manual_control_setpoint_poll();
|
||||
vehicle_attitude_poll();
|
||||
vehicle_control_mode_poll();
|
||||
wind_poll(now);
|
||||
|
||||
if (_vehicle_land_detected_sub.updated()) {
|
||||
vehicle_land_detected_s vehicle_land_detected;
|
||||
|
||||
|
||||
Reference in New Issue
Block a user