Auterion App SDK
Auterion SDK is a library that can be used by AuterionOS apps to communicate with the system.
Loading...
Searching...
No Matches
los_specific_force_controller.hpp
1/****************************************************************************
2 *
3 * Copyright 2026 Auterion. All rights reserved.
4 *
5 ****************************************************************************/
6
7#pragma once
8
9#include <Eigen/Eigen>
10#include <limits>
11#include <memory>
12#include <optional>
13
14namespace auterion {
15
21
31 public:
34 Eigen::Quaterniond q_body_camera{Eigen::Quaterniond::Identity()};
37 double horizontal_min{-0.5};
38 double horizontal_max{0.5};
39 double vertical_min{-0.5};
40 double vertical_max{0.5};
41
42 bool valid() const;
43 };
44
45 struct Parameters {
47 double sf_p{0.05};
49 double sf_i{5.0};
53 double sf_sp_p_weight{0.0};
56 double sf_p_airspeed_ref{0.0};
58 double att_lpf_tc{0.1};
61 double cam_vfov{30.0};
64 double cam_hfov{0.0};
67 double cam_pitch{0.0};
72 double thrust_min{0.0};
74 double thrust_max{1.0};
77 double thrust_los_x_max{std::numeric_limits<double>::infinity()};
88 std::optional<CameraGeometry> camera_geometry{};
89 };
90
91 struct State {
93 Eigen::Matrix3d los_to_enu{Eigen::Matrix3d::Identity()};
95 Eigen::Vector3d sf_sp_enu{Eigen::Vector3d::Zero()};
98 Eigen::Vector3d sf_sp_los{Eigen::Vector3d::Zero()};
100 Eigen::Vector3d sf_los{Eigen::Vector3d::Zero()};
102 Eigen::Vector3d thrust_sp_enu{Eigen::Vector3d::Zero()};
104 Eigen::Vector3d thrust_sp_los{Eigen::Vector3d::Zero()};
110 Eigen::Quaterniond attitude_sp_enu{Eigen::Quaterniond::Identity()};
117 Eigen::Vector3d sf_los_prev{Eigen::Vector3d::Zero()};
120 Eigen::Vector3d sf_sp_los_prev{Eigen::Vector3d::Zero()};
122 bool initialized{false};
123 };
124
129 explicit LosSpecificForceController(const Parameters& parameters);
130
135 void setParameters(const Parameters& parameters);
136
150 void setInitialThrustNormalized(double thrust_normalized);
151
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);
169
173 const State& state() const;
174
175 private:
176 std::shared_ptr<LosSpecificForceControllerImpl> _impl;
177};
178
179} // namespace auterion
Implementation details for the LosSpecificForceController class.
Line-of-Sight (LOS) attitude controller for multicopters.
Definition los_specific_force_controller.hpp:30
LosSpecificForceController(const Parameters &parameters)
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 &parameters)
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