38 double horizontal_max{0.5};
39 double vertical_min{-0.5};
40 double vertical_max{0.5};
100 Eigen::Vector3d
sf_los{Eigen::Vector3d::Zero()};
165 void update(
float dt_s,
bool hold,
double max_thrust_rate_los_x,
const Eigen::Vector3d& los,
166 const Eigen::Vector3d& acc_sp_enu,
const Eigen::Quaterniond& attitude_enu,
167 const Eigen::Vector3d& specific_force_flu,
168 std::optional<double> true_airspeed = std::nullopt);
176 std::shared_ptr<LosSpecificForceControllerImpl> _impl;
Implementation details for the LosSpecificForceController class.
Line-of-Sight (LOS) attitude controller for multicopters.
Definition los_specific_force_controller.hpp:30
LosSpecificForceController(const Parameters ¶meters)
Constructs a LosSpecificForceController with the given parameters.
void update(float dt_s, bool hold, double max_thrust_rate_los_x, const Eigen::Vector3d &los, const Eigen::Vector3d &acc_sp_enu, const Eigen::Quaterniond &attitude_enu, const Eigen::Vector3d &specific_force_flu, std::optional< double > true_airspeed=std::nullopt)
Runs one update step of the LOS controller.
const State & state() const
Returns a const reference to the current controller state.
void setParameters(const Parameters ¶meters)
Updates the controller parameters.
void setInitialThrustNormalized(double thrust_normalized)
Seed the initial normalized thrust for a glitch-free takeover.
Definition los_specific_force_controller.hpp:32
double horizontal_min
Definition los_specific_force_controller.hpp:37
Eigen::Quaterniond q_body_camera
Camera (right, down, forward) to body FLU rotation.
Definition los_specific_force_controller.hpp:34
Definition los_specific_force_controller.hpp:45
double thrust_min
Minimum normalized thrust command output [0, 1].
Definition los_specific_force_controller.hpp:72
double sf_sp_p_weight
Definition los_specific_force_controller.hpp:53
double hover_thrust_normalized
Definition los_specific_force_controller.hpp:70
double cam_pitch
Definition los_specific_force_controller.hpp:67
double sf_i
Integral gain of the specific-force controller.
Definition los_specific_force_controller.hpp:49
double att_lpf_tc
Time constant of the attitude setpoint low-pass filter [s]. Set to 0 to disable.
Definition los_specific_force_controller.hpp:58
double thrust_max
Maximum normalized thrust command output [0, 1].
Definition los_specific_force_controller.hpp:74
double sf_p_airspeed_ref
Definition los_specific_force_controller.hpp:56
double cam_vfov
Definition los_specific_force_controller.hpp:61
double sf_p
Proportional gain of the specific-force controller.
Definition los_specific_force_controller.hpp:47
double cam_pointing_max_rate_deg_per_s
Definition los_specific_force_controller.hpp:82
double thrust_los_x_max
Definition los_specific_force_controller.hpp:77
std::optional< CameraGeometry > camera_geometry
Definition los_specific_force_controller.hpp:88
double tilt_max_rate_deg_per_s
Maximum tilt rate [deg/s]. Limits how fast the thrust vector can tilt.
Definition los_specific_force_controller.hpp:79
double cam_hfov
Definition los_specific_force_controller.hpp:64
double cam_image_roll_max_rate_deg_per_s
Definition los_specific_force_controller.hpp:85
Definition los_specific_force_controller.hpp:91
Eigen::Vector3d sf_los_prev
Definition los_specific_force_controller.hpp:117
double thrust_command_normalized
Normalized thrust command in [0, 1].
Definition los_specific_force_controller.hpp:112
double desired_thrust_rate_los_x
Thrust rate being applied along the LOS x-axis [normalized/s].
Definition los_specific_force_controller.hpp:108
Eigen::Vector3d thrust_sp_enu
Thrust setpoint in ENU frame [normalized].
Definition los_specific_force_controller.hpp:102
Eigen::Matrix3d los_to_enu
Rotation matrix from LOS frame to ENU frame.
Definition los_specific_force_controller.hpp:93
Eigen::Vector3d sf_sp_los
Definition los_specific_force_controller.hpp:98
double thrust_command_abs
Absolute thrust command [normalized, unbounded before hover thrust scaling].
Definition los_specific_force_controller.hpp:114
double sf_p_airspeed_scale
Scale applied to sf_p from the airspeed, in (0, 1].
Definition los_specific_force_controller.hpp:106
bool initialized
False until the first call to update(), after which the controller is fully initialized.
Definition los_specific_force_controller.hpp:122
Eigen::Vector3d sf_sp_enu
Specific force setpoint in ENU frame [m/s²].
Definition los_specific_force_controller.hpp:95
Eigen::Vector3d sf_los
Measured specific force in LOS frame [m/s²]. X component is always 0.
Definition los_specific_force_controller.hpp:100
Eigen::Vector3d thrust_sp_los
Thrust setpoint in LOS frame [normalized].
Definition los_specific_force_controller.hpp:104
Eigen::Vector3d sf_sp_los_prev
Definition los_specific_force_controller.hpp:120
Eigen::Quaterniond attitude_sp_enu
Attitude setpoint in ENU frame (after filtering and limiting).
Definition los_specific_force_controller.hpp:110