89 (ParamFloat<px4::params::MIS_YAW_ERR>) _param_mis_yaw_err,
90 (ParamFloat<px4::params::MPC_ACC_HOR>) _param_mpc_acc_hor,
91 (ParamFloat<px4::params::MPC_ACC_UP_MAX>) _param_mpc_acc_up_max,
92 (ParamFloat<px4::params::MPC_ACC_DOWN_MAX>) _param_mpc_acc_down_max,
93 (ParamFloat<px4::params::MPC_JERK_AUTO>) _param_mpc_jerk_auto,
94 (ParamFloat<px4::params::MPC_XY_TRAJ_P>) _param_mpc_xy_traj_p,
95 (ParamFloat<px4::params::MPC_Z_TRAJ_P>) _param_mpc_z_traj_p
static float _constrainOneSide(float val, float constraint)
Constrain val between INF and constraint.
void _ekfResetHandlerPositionZ() override
void checkSetpoints(vehicle_local_position_setpoint_s &setpoints)
FlightTaskAutoLineSmoothVel()=default
float _getMaxSpeedFromDistance(float braking_distance, float final_speed) const
void reActivate() override
Call this to reset an active Flight Task.
void _prepareSetpoints()
Generate velocity target points for the trajectory generator.
void _ekfResetHandlerHeading(float delta_psi) override
static float _constrainAbs(float val, float max)
void _generateTrajectory()
Abstract Flight task which generates local setpoints based on the triplet type.
virtual ~FlightTaskAutoLineSmoothVel()=default
void _ekfResetHandlerVelocityZ() override
bool _generateHeadingAlongTraj()
Generates heading along trajectory.
bool activate(vehicle_local_position_setpoint_s last_setpoint) override
Call once on the event where you switch to the task.
TODO: document the algorithm |T1| T2 |T3| __| |____ __ Jerk |_| / \ Acceleration ___/ ___ ;" / / V...
bool _checkTakeoff() override
determines when to trigger a takeoff (ignored in flight)
float _getSpeedAtTarget(float next_target_speed) const
Constrain the value -max <= val <= max.
void _ekfResetHandlerVelocityXY() override
constexpr _Tp max(_Tp a, _Tp b)
VelocitySmoothing _trajectory[3]
Trajectories in x, y and z directions.
void _generateSetpoints() override
Generate setpoints along line.
void _ekfResetHandlerPositionXY() override
Reset position or velocity setpoints in case of EKF reset event.
void _updateTrajConstraints()
DEFINE_PARAMETERS_CUSTOM_PARENT(FlightTaskAutoMapper2,(ParamFloat< px4::params::MIS_YAW_ERR >) _param_mis_yaw_err,(ParamFloat< px4::params::MPC_ACC_HOR >) _param_mpc_acc_hor,(ParamFloat< px4::params::MPC_ACC_UP_MAX >) _param_mpc_acc_up_max,(ParamFloat< px4::params::MPC_ACC_DOWN_MAX >) _param_mpc_acc_down_max,(ParamFloat< px4::params::MPC_JERK_AUTO >) _param_mpc_jerk_auto,(ParamFloat< px4::params::MPC_XY_TRAJ_P >) _param_mpc_xy_traj_p,(ParamFloat< px4::params::MPC_Z_TRAJ_P >) _param_mpc_z_traj_p)