74 (ParamFloat<px4::params::MPC_HOLD_MAX_Z>) _param_mpc_hold_max_z,
75 (ParamInt<px4::params::MPC_ALT_MODE>) _param_mpc_alt_mode,
76 (ParamFloat<px4::params::MPC_HOLD_MAX_XY>) _param_mpc_hold_max_xy,
77 (ParamFloat<px4::params::MPC_Z_P>) _param_mpc_z_p,
78 (ParamFloat<px4::params::MPC_MAN_Y_MAX>) _param_mpc_man_y_max,
79 (ParamFloat<px4::params::MPC_MAN_Y_TAU>) _param_mpc_man_y_tau,
80 (ParamFloat<px4::params::MPC_MAN_TILT_MAX>) _param_mpc_man_tilt_max,
81 (ParamFloat<px4::params::MPC_LAND_ALT1>) _param_mpc_land_alt1,
82 (ParamFloat<px4::params::MPC_LAND_ALT2>) _param_mpc_land_alt2,
83 (ParamFloat<px4::params::MPC_LAND_SPEED>)
84 _param_mpc_land_speed,
85 (ParamFloat<px4::params::MPC_TKO_SPEED>)
bool _checkTakeoff() override
Determine when to trigger a takeoff (ignored in flight)
bool updateInitialize() override
Call before activate() or update() to initialize time and input data.
uint8_t _reset_counter
counter for estimator resets in z-direction
bool update() override
To be called regularly in the control loop cycle to execute the task.
DEFINE_PARAMETERS_CUSTOM_PARENT(FlightTaskManual,(ParamFloat< px4::params::MPC_HOLD_MAX_Z >) _param_mpc_hold_max_z,(ParamInt< px4::params::MPC_ALT_MODE >) _param_mpc_alt_mode,(ParamFloat< px4::params::MPC_HOLD_MAX_XY >) _param_mpc_hold_max_xy,(ParamFloat< px4::params::MPC_Z_P >) _param_mpc_z_p,(ParamFloat< px4::params::MPC_MAN_Y_MAX >) _param_mpc_man_y_max,(ParamFloat< px4::params::MPC_MAN_Y_TAU >) _param_mpc_man_y_tau,(ParamFloat< px4::params::MPC_MAN_TILT_MAX >) _param_mpc_man_tilt_max,(ParamFloat< px4::params::MPC_LAND_ALT1 >) _param_mpc_land_alt1,(ParamFloat< px4::params::MPC_LAND_ALT2 >) _param_mpc_land_alt2,(ParamFloat< px4::params::MPC_LAND_SPEED >) _param_mpc_land_speed,(ParamFloat< px4::params::MPC_TKO_SPEED >) _param_mpc_tko_speed) private void _unlockYaw()
FlightTaskManualAltitude()=default
void _respectMinAltitude()
Minimum Altitude during range sensor operation.
#define ORB_ID(_name)
Generates a pointer to the uORB metadata structure for a given topic.
void _rotateIntoHeadingFrame(matrix::Vector2f &vec)
rotates vector into local frame
virtual ~FlightTaskManualAltitude()=default
void _updateAltitudeLock()
Check and sets for position lock.
void _ekfResetHandlerHeading(float delta_psi) override
adjust heading setpoint in case of EKF reset event
void _updateHeadingSetpoints()
sets yaw or yaw speed
void _respectGroundSlowdown()
Sets downwards velocity constraint based on the distance to ground.
virtual void _updateSetpoints()
updates all setpoints
float _applyYawspeedFilter(float yawspeed_target)
Filter between stick input and yaw setpoint.
bool activate(vehicle_local_position_setpoint_s last_setpoint) override
Call once on the event where you switch to the task.
void _respectMaxAltitude()
uORB::SubscriptionData< home_position_s > _sub_home_position
Linear and exponential map from stick inputs to range -1 and 1.
float _yawspeed_filter_state
state of low-pass filter in rad/s
bool _terrain_hold
true when vehicle is controlling height above a static ground position
void _terrainFollowing(bool apply_brake, bool stopped)
Terrain following.
virtual void _scaleSticks()
scales sticks to velocity in z
float _dist_to_ground_lock
Distance to ground during terrain following.
bool _terrain_follow
true when the vehicle is following the terrain height