10#include <wpi/math/linalg/EigenCore.hpp>
11#include <wpi/units/angular_velocity.hpp>
12#include <wpi/units/time.hpp>
13#include <wpi/units/voltage.hpp>
91 wpi::units::volt_t
Step(
double reference,
double output,
const std::vector<double>& refDerivatives = {});
101 wpi::units::volt_t
Calculate(
double measurement,
double setpoint);
115 wpi::units::volt_t
Calculate(
double measurement,
double setpoint, wpi::units::volt_t appliedOutput);
167 void Reset(
const std::vector<double>& xhatInit, wpi::units::volt_t uInit);
195 const std::shared_ptr<ADRCConfig>&
GetConfig()
const {
return m_config; }
210 static double Bandwidth(
int systemOrder,
double bandwidthScale, wpi::units::second_t settlingTime);
223 static ADRCGains ComputeGains(
int systemOrder,
double wc,
double b0,
double dt,
double backEmfRate = 0.0);
226 void RequireInitialized()
const;
228 std::shared_ptr<ADRCConfig> m_config;
230 Eigen::VectorXd m_xhat;
231 Eigen::VectorXd m_secondaryXhat;
233 std::vector<double> m_uHistory;
234 std::optional<TrackingDifferentiator> m_td;
235 bool m_initialized{
false};
wpi::units::volt_t Calculate(double measurement, Reference now, Reference next, wpi::units::volt_t appliedOutput)
wpi::units::volt_t Calculate(double measurement, double setpoint)
int GetSystemOrder() const
Definition ADRCController.hpp:191
const TrackingDifferentiator * GetTrackingDifferentiator() const
wpi::units::volt_t Calculate(double measurement, double setpoint, wpi::units::volt_t appliedOutput)
void Reset(double measurement)
wpi::units::second_t GetSettlingTime() const
double GetBandwidthScale() const
std::vector< double > GetEstimatedStates() const
ADRCController(std::shared_ptr< ADRCConfig > config)
wpi::units::volt_t GetLastOutput() const
bool IsInitialized() const
Definition ADRCController.hpp:197
void Initialize(double b0, wpi::units::second_t period)
void Reset(const std::vector< double > &xhatInit, wpi::units::volt_t uInit)
friend class ADRCConfig
Definition ADRCController.hpp:200
wpi::units::radians_per_second_t GetObserverBandwidth() const
double GetEstimatedDisturbance() const
wpi::units::radians_per_second_t GetBandwidth() const
const std::shared_ptr< ADRCConfig > & GetConfig() const
Definition ADRCController.hpp:195
int GetControllerOrder() const
Definition ADRCController.hpp:193
wpi::units::volt_t Step(double reference, double output, const std::vector< double > &refDerivatives={})
Definition TrackingDifferentiator.hpp:51
Definition ADRCConfig.hpp:24
Definition ADRCController.hpp:121
double rate
How fast it is changing, per second.
Definition ADRCController.hpp:123
double value
The setpoint.
Definition ADRCController.hpp:122
static Reference Still(double value)
Definition ADRCController.hpp:126
Definition ADRCConfig.hpp:32