|
|
|
@ -23,9 +23,9 @@ public:
@@ -23,9 +23,9 @@ public:
|
|
|
|
|
/// @param initial_i Initial value for the I term.
|
|
|
|
|
/// @param initial_imax Initial value for the imax term.4
|
|
|
|
|
///
|
|
|
|
|
APM_PI(const float &initial_p = 0.0, |
|
|
|
|
const float &initial_i = 0.0, |
|
|
|
|
const int16_t &initial_imax = 0.0) |
|
|
|
|
APM_PI(const float & initial_p = 0.0, |
|
|
|
|
const float & initial_i = 0.0, |
|
|
|
|
const int16_t & initial_imax = 0.0) |
|
|
|
|
{ |
|
|
|
|
_kp = initial_p; |
|
|
|
|
_ki = initial_i; |
|
|
|
@ -67,21 +67,37 @@ public:
@@ -67,21 +67,37 @@ public:
|
|
|
|
|
//@{
|
|
|
|
|
|
|
|
|
|
/// Overload the function call operator to permit relatively easy initialisation
|
|
|
|
|
void operator() (const float p, |
|
|
|
|
void operator () (const float p, |
|
|
|
|
const float i, |
|
|
|
|
const int16_t imaxval) { |
|
|
|
|
_kp = p; _ki = i; _imax = imaxval; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
float kP() const { return _kp.get(); } |
|
|
|
|
float kI() const { return _ki.get(); } |
|
|
|
|
int16_t imax() const { return _imax.get(); } |
|
|
|
|
float kP() const { |
|
|
|
|
return _kp.get(); |
|
|
|
|
} |
|
|
|
|
float kI() const { |
|
|
|
|
return _ki.get(); |
|
|
|
|
} |
|
|
|
|
int16_t imax() const { |
|
|
|
|
return _imax.get(); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void kP(const float v) { _kp.set(v); } |
|
|
|
|
void kI(const float v) { _ki.set(v); } |
|
|
|
|
void imax(const int16_t v) { _imax.set(abs(v)); } |
|
|
|
|
float get_integrator() const { return _integrator; } |
|
|
|
|
void set_integrator(float i) { _integrator = i; } |
|
|
|
|
void kP(const float v) { |
|
|
|
|
_kp.set(v); |
|
|
|
|
} |
|
|
|
|
void kI(const float v) { |
|
|
|
|
_ki.set(v); |
|
|
|
|
} |
|
|
|
|
void imax(const int16_t v) { |
|
|
|
|
_imax.set(abs(v)); |
|
|
|
|
} |
|
|
|
|
float get_integrator() const { |
|
|
|
|
return _integrator; |
|
|
|
|
} |
|
|
|
|
void set_integrator(float i) { |
|
|
|
|
_integrator = i; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
static const struct AP_Param::GroupInfo var_info[]; |
|
|
|
|
|
|
|
|
|