mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-05-24 15:40:31 +08:00
navigator: fix vehicle_status update (#12364)
This commit is contained in:
@@ -387,7 +387,6 @@ private:
|
||||
|
||||
// update subscriptions
|
||||
void params_update();
|
||||
void vehicle_status_update();
|
||||
|
||||
/**
|
||||
* Publish a new position setpoint triplet for position controllers
|
||||
|
||||
@@ -116,15 +116,6 @@ Navigator::~Navigator()
|
||||
orb_unsubscribe(_local_pos_sub);
|
||||
}
|
||||
|
||||
void
|
||||
Navigator::vehicle_status_update()
|
||||
{
|
||||
if (_vstatus_sub.update(&_vstatus)) {
|
||||
/* in case the commander is not be running */
|
||||
_vstatus.arming_state = vehicle_status_s::ARMING_STATE_STANDBY;
|
||||
}
|
||||
}
|
||||
|
||||
void
|
||||
Navigator::params_update()
|
||||
{
|
||||
@@ -156,8 +147,6 @@ Navigator::run()
|
||||
_geofence.loadFromFile(GEOFENCE_FILENAME);
|
||||
}
|
||||
|
||||
/* copy all topics first time */
|
||||
vehicle_status_update();
|
||||
params_update();
|
||||
|
||||
/* wakeup source(s) */
|
||||
@@ -218,7 +207,7 @@ Navigator::run()
|
||||
params_update();
|
||||
}
|
||||
|
||||
vehicle_status_update();
|
||||
_vstatus_sub.update(&_vstatus);
|
||||
_land_detected_sub.update(&_land_detected);
|
||||
_position_controller_status_sub.update();
|
||||
_home_pos_sub.update(&_home_pos);
|
||||
|
||||
Reference in New Issue
Block a user