mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-16 23:43:33 +08:00
FlightTaskOffboard: only start task if control mode flags are met
This commit is contained in:
committed by
Lorenz Meier
parent
bf4ac7a9d6
commit
b5731e0ccd
@@ -55,6 +55,8 @@ bool FlightTaskOffboard::initializeSubscriptions(SubscriptionArray &subscription
|
||||
bool FlightTaskOffboard::updateInitialize()
|
||||
{
|
||||
bool ret = FlightTask::updateInitialize();
|
||||
// require a valid triplet
|
||||
ret = ret && _sub_triplet_setpoint->get().current.valid;
|
||||
// require valid position / velocity in xy
|
||||
return ret && PX4_ISFINITE(_position(0))
|
||||
&& PX4_ISFINITE(_position(1))
|
||||
@@ -245,5 +247,4 @@ bool FlightTaskOffboard::update()
|
||||
}
|
||||
|
||||
return true;
|
||||
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user